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The  need  of  improving  the  motion  capabilities  of  robots  is  evident  in  the 
number  of  difficult  tasks  that  industrial  robots  are  now  required  to  perform.  In 
many  of  these  new  applications,  the  performance  requirements  may  exceed  the 
capabilities  of  the  robot.  For  example,  precision  machining  applications  require  the 
position  of  the  tool  be  accurately  controlled  and  this  is  typically  accomplished  by 
using  rigid  templates  to  guide  the  robot  over  the  desired  path.  A  different  template 
must  be  manufactured  for  each  different  type  of  part.  These  templates,  while 
providing  absolute  positioning  capabilities  for  the  robot,  are  expensive  to  produce 
and  limit  the  flexibile  manufacturing  capabilities  of  the  robot.  To  increase  the 
economy  of  robots  in  precision  machining  applications,  rigid  templates  should  be 
eliminated  and  replaced  by  alternate  compensation  methods.  Several  practical 
methods  for  improving  the  motion  capabilities  of  a  particular  industrial  robot  have 


been  developed  by  the  author  and  they  include  dynamic  compensation  for  changes 
in  load  torque,  flexibility  compensation  of  the  robot  structure,  and  accelerometric 
compensation  to  improve  the  straight  line  motion  capabilities  of  the  robot. 

The  application  of  this  research  was  to  develop  a  method  which  allowed  the 
robot  to  perform  edge  milling  of  sheetmetal  aircraft  and  spacecraft  components 
without  the  aid  of  templates.  The  errors  of  the  robot  due  to  flexibility  were 
modeled  and  compensated  for,  and  a  dynamic  compensation  technique  was 
developed  and  successfully  demonstrated.  The  errors  due  to  sensors,  round  off, 
interpolation,  and  environmental  factors  were  combined  into  a  single  common  error 
defined  as  straight  line  motion  error.  A  compensation  technique  was  designed  to 
improve  the  straight  line  motion  of  the  robot  using  an  accelerometric  compensation 
technique. 

In  addition,  to  provide  the  necessary  compensation  displacement  of  the  tool,  a 
high  speed  active  end  effector  was  developed  and  installed  on  the  robot.  This 
device  allowed  high  resolution,  high  speed  displacements  of  the  pnuematic  router 
used  in  the  milling  operation.  Although  developed  for  position  compensation,  force 
compensation  techniques  using  this  end  effector  were  also  described. 


CHAPTER  1 
INTRODUCTION 


Robots  have  been  utilized  in  the  manufacturing  environment  since  1961  when  a  Uni- 
mation  robot  was  installed  at  a  General  Motors  plant  to  tend  a  die  casting  machine.  Since 
that  time,  thousands  of  robots  have  been  installed  world-wide,  the  majority  in  metal 
working  or  other  'heavy'  industrial  applications.  The  first  applications  usually  involved 
the  handling  of  items  in  hostile  environments,  such  as  those  found  around  furnaces  or  die 
casting  machines  [1]. 

Improved  accuracy  and  control  made  applications  in  spot  welding  and  paint  spraying 
viable,  as  these  tasks  would  also  expose  humans  to  hostile  surroundings.  The  improved 
accuracy  also  opened  robotics  to  applications  outside  of  traditional  heavy  industries  in- 
cluding: automated  assembly  and  inspection  of  electronic  components,  template  guided 
drilling  and  machining  of  aerospace  components  and  even  decorating  chocolate  candies  on 
an  assembly  line  [2]. 

Still,  there  are  limitations  in  the  accuracy  and  control  of  robots,  reducing  the  number  of 
applications  in  industry.  As  CAD  AM  type  systems  become  the  standard  for  machine  tools, 
the  limitations  of  robots  become  more  evident.  Presently,  most  robots  are  programmed 
by  manually  teaching  each  move  and  position  required  to  perform  the  task.  This  does 
not  present  a  serious  problem  when  the  task  is  to  be  repeated  continuously  or  at  frequent 
intervals.  However,  this  method  of  programming  becomes  impractical  for  applications 
involving  low  volume  or  non-repeated  tasks  as  often  encountered  in  the  aero-space  industry. 
For  applications  of  robots  in  this  area  of  low  volume  production,  two  enhancements 
are  required  to  provide  economic  production.  First,  allow  off-line  programing  of  robots 
in  a  manner  similar  to  other  numerically  controlled  machine  tools.  Second,  improve  the 
absolute  positional  accuracy  of  robots  so  that  the  taught  position  will  meet  the  manufac- 
turing tolerances  of  the  part  to  be  machined.   When  robots  are  programmed  with  teach 


pendants,  the  repeatability  at  the  tool  of  a  typical  robot  is  approximately  +/-  0.010  inch 
(0.254  mm),  which  meets  the  tolerance  requirements  of  most  components.  However,  the 
absolute  positioning  error  approaches  +/-  0.10  inch  (2.54  mm)  when  the  same  robot  is 
taught  off-line.  These  errors  are  too  great  and  must  be  corrected.  Currently,  rigid  tem- 
plates are  used  to  increase  the  accuracy  of  the  tool  mounted  on  the  robot.  An  alternative 
method  to  improving  the  accuracy  of  the  robot  may  be  achieved  in  part  by  modeling  those 
factors  which  reduce  robot  accuracy  and  include  their  eifects  in  the  robot  controller. 

The  overall  task  of  this  research  was  to  develop  a  templateless  edge  milling  technique 
which  could  be  installed  on  an  existing  industrial  robot.  As  the  initial  task  was  investi- 
gated, several  additional  tasks  were  discovered  which  required  examination.  Mainly,  these 
tasks  involved  improving  the  motion  capabilities  of  the  manipulator. 

The  primary  effort  for  the  remainder  of  this  work  is  focused  on  providing  practical 
methods  of  improving  the  quality  of  motion  of  an  existing  industrial  robot.  Several  areas 
affecting  the  accuracy  of  the  robot  were  explored:  eliminating  deflections  of  the  end  effector 
due  to  structural  flexibilities,  and  improving  the  straight  line  motion  capabilities  of  the 
robot.  As  a  by-product  of  this  work,  a  high  resolution,  fast  response  active  end  effector  was 
produced  to  provide  the  necessary  compensation  displacement.  Additionally,  a  method  to 
improve  the  dynamic  response  of  the  manipulator  was  investigated,  resulting  in  a  dynamic 
compensator  being  built  and  tested  on  the  base  axis  of  the  robot. 

Industrial  robots  are  currently  used  to  mill  the  edges  of  complex  three  dimensional 
sheet  metal  parts  of  aircraft  and  spacecraft.  When  using  templates,  the  robot  is  "ap- 
proximately" programmed  for  the  desired  contour  of  the  workpiece  and  a  compliant  end 
effector  equipped  with  rollers  follows  the  rigid  template.  In  this  way,  errors  in  the  desired 
motion  of  the  robot  can  be  eliminated,  and  accurately  machined  workpieces  will  be  pro- 
duced. However,  the  templates  themselves  must  be  accurately  machined  for  each  different 
workpiece.  This  limits  the  flexible  machining  nature  of  the  robot  and  adds  a  great  deal  of 
cost  to  limited  production  items. 

Therefore,  to  increase  the  productivity  of  the  robot  and  to  reduce  the  manufacturing 


costs  of  these  components,  the  use  of  templates  must  be  eliminated.  However,  when 
templates  are  eliminated,  the  resulting  manufactured  items  are  of  sub-standard  quality, 
caused  by  motion  errors  of  the  robot.  Specific  causes  of  these  motion  errors  will  be 
described  later  in  this  chapter;  however,  three  general  categories  have  been  investigated 
and  they  include: 

t  The  transient  errors  due  to  the  inadequate  dynamics  of  the  servo  drives  of  the  robot. 

•  The  deflection  errors  at  the  end  effector  due  to  the  applied,  variable  cutting  forces 
during  the  edge  milhng  operation. 

•  The  errors  in  the  motion  of  the  robot  due  to  path  generation  errors  and  coarse 
resolution  of  the  servo  loops. 

Practical  methods  to  eliminate  the  errors  of  motion  described  above  were  also  examined, 
implemented  and  the  results  will  be  described  later. 

Background 

Presently,  much  time  and  effort  has  been  expended  on  improving  the  positional  ac- 
curacy of  standard  industrial  robots.  Recent  applications  for  robots  with  high  positional 
accuracies  include: 

•  Inspection  of  parts  for  dimensional  accuracy. 

•  Templateless  metal  removal. 

•  Precision  assembly  tasks. 

•  Applications  where  position  commands  are  down  loaded  from  CAD  systems. 

In  the  past  twenty  years,  robots  have  been  used  in  a  large  number  of  applications, 
ranging  from  nuclear  maintenance  to  automobile  manufacturing  to  electronic  assembly. 
They  are  generally  flexible,  re-programmable  and  repeatable  from  cycle  to  cycle.  However, 
for  many  of  the  new  industrial  applications,  good  repeatabihty  is  insufficient  to  satisfy  the 
application  requirements.  Improved  accuracy  is  also  required  from  the  robots. 


Accuracy  is  defined  as  a  measure  of  the  difference  between  the  commanded  posi- 
tion/trajectory of  the  end  effector  and  the  actual  position/trajectory  of  the  end  effector. 

■1 

The  position  of  the  end  effector  is  most  commonly  commanded  in  global  coordinates, 

fixed  to  the  base  of  the  robot,  and  is  especially  useful  in  offline  programming  of  the  robot. 

Repeatability  is  defined  as  the  difference  in  position/trajectory  of  the  robot  for  repeated 

cycles  of  a  commanded  position/trajectory  of  the  robot  [3].  Repeatability  issues  are  very 

important  for  motion  which  are  taught  online,  usually  with  a  teach  pendant. 

The  importance  of  accuracy  in  robots  has  been  recognized  in  the  early  years  by  the 
pioneers  of  the  industry  including  Bejczy,  Paul,  Roth  and  Whitney.  Through  the  years, 
the  development  of  improved  kinematic  and  dynamic  algorithms,  sensors  and  controllers 
have  been  witnessed.  All  of  this  has  led  to  improved  accuracy  of  robots;  however,  with 
the  advancement  of  off-line  CAD  based  robot  path  planning  and  other  requirements  for 
greater  positional  accuracy,  the  improvements  fall  short.  Additional  methods  need  to  be 
developed  to  span  the  gap. 

Before  the  trajectory  errors  can  be  eliminated,  the  causes  of  the  errors  should  be 
determined.  Day  [4]  has  identified,  described  and  grouped  a  number  of  factors  which 
influence  the  accuracy  of  robots: 

1.  'Environmental  factors'  such  as  temperature,  humidity,  and  electrical  noise. 

2.  'Kinematic  factors'  such  as  in-accurate  joint  lengths,  misaligned  joints,  and  other 
manufacturing  defects. 

3.  'Dynamic  factors'  such  as  structural  flexibilities,  drive  train  flexibilities,  friction  pa- 
rameters, varying  inertial  loads  and  other  non-linearities  like  backlash  and  hysteresis. 

4.  'Measurement  factors'  such  as  resolution  and  non-linearities  of  encoders,  resolvers, 
etc. 

5.  'Computational  factors'  such  as  robot  path  computation  errors  due  to  round-off, 
steady  state  control  errors,  errors  due  to  dropped  bits,  feedback  control  methods. 


etc. 

6.  'Application  factors'  such  as  installation  errors,  part  presentation  errors,  errors  in 
defining  part  location  or  coordinate  frame  and  errors  in  defining  location  of  the 
end-of-tool. 

These  factors  influence  both  the  accuracy  and  the  repeatability  of  the  robot.  The 
efforts  of  this  research  focus  on  robot  repeatabihty  issues  of  robot  motion;  however,  im- 
provements in  the  repeatabihty  of  the  robot  usually  help  to  improve  the  accuracy  of  the 
robot  and  vice-versa.  Each  factor  causing  errors  in  accuracy  and  repeatability  may  not  be 
totally  independent  from  one  another.  For  instance,  a  large  temperature  change  affects 
link  length,  friction  coefficients,  drifts  in  control  electronics  and  measurement  sensitivity. 

To  further  understand  the  needs  of  the  templateless  edge  milling  operation,  a  descrip- 
tion of  the  operation  will  be  presented  in  the  next  section. 

Templateless  Edge  Milhng 

Robots  are  currently  being  used  for  edge  milling  operations  in  the  aircraft  and  space- 
craft industry.  Similar  robotic  applications  include:  drilling,  deburring  and  riveting  with 
templates. 

A  template  provides  a  rigid  surface  for  the  routing  end  effector  to  follow,  as  shown  in 
Figure  1.1.  The  spring-loaded  roller  follower  always  remains  in  contact  with  the  template 
because  the  force  provided  by  the  compressed  spring  more  than  offsets  any  cutting  forces 
produced  by  the  milhng  operation.  Thus,  as  long  as  the  roller  followers  remain  in  contact 
with  the  template,  the  path  of  the  tool,  and  the  shape  of  the  workpiece  is  defined.  Any 
contour  errors  of  the  template  result  in  errors  of  the  workpiece.  To  eliminate  or  reduce 
these  errors,  the  templates  must  be  expertly  manufactured  and  rigidly  clamped  to  the 
workpiece.  The  costs  of  producing  these  templates  are  large,  especially  when  considering 
that  a  different  template  must  be  made  for  each  different  type  of  part  to  machined. 

The  following  description  of  a  routing  (or  edge  milling)  task  was  taken  from  a  robotics 


Figure  1.1:  Template  Following  End  Effector  For  Edge  Milling 

ad-hoc  study  of  a  major  aircraft  manufacturer: 

The  formed  part  is  positioned  on  a  contoured  fixture  and  pinned  to  it 
with  hold  down  screws.  A  routing  blanket  is  then  applied  and  pinned  to  the 
fixture.  The  T3  Cincinnati  Milacron  Robot  is  programmed  to  traverse  the 
routed  profile  and  the  attached  'DOTCO'  router  actually  cuts  the  material. 
The  parts,  as  per  the  existing  manufacturing  method,  are  trimmed  to  +.030" 
or  as  directed  by  the  trim  allowance  of  the  routing  blanket  ....  The  robot 
has  been  developed  to  replace  manual  routing  of  these  parts.  A  special  end 
effector  was  developed  to  hold  a  1/2  H.P.  air  driven  'DOTCO'  router  for  this 
job.  We  have  found  the  1/4"  two  fluted  router  bit  (TRM  67.09-108-lTl)  to  be 
the  best  cutter  for  the  application.  Increase  of  efHciency:  3  times  vs.  manual 
routing.  [5]  pp  35-36. 


Thus,  routing  blankets  or  templates  were  used  to  guide  the  robot  and  the  parts  were 
trimmed  to  +0.030  inch  (0.76  mm).  For  parts  requiring  greater  precision,  other  methods 
would  have  to  be  employed. 

When  large  runs  of  a  siiigle  part  are  made,  the  cost  of  the  template  for  that  part  is 
distributed  over  the  complete  lot  of  parts.  However,  for  runs  of  100  parts  or  less  (common 
for  aircraft  or  spacecraft)  the  distributed  costs  of  the  template  is  quite  large.  In  addition, 
the  use  of  templates  limit  the  flexibility  of  the  robot  production  because  the  manufacturing 
of  these  templates  increase  the  leadtime  for  production,  new  templates  must  be  made  for 


each  new  parts,  and  the  templates  have  to  be  altered  each  time  a  modification  is  made 

to  the  existing  part.  For  these  reasons,  robots  are  sometimes  not  chosen  for  the  routing, 

drilling,  or  riveting  operations.  By  eliminating  the  need  for  the  template,  the  number  of 

robotic  applications  in  aircraft  manufacturing  and  other  industries  could  rise  significantly. 

An  additional  project  in  the  previously  mentioned  ad-hoc  report  included  the  following 

proposal: 

Our  prime  objective  in  this  research  project  is  to  improve  the  dynamic  po- 
sitioning precision  of  current  robots  so  they  can  perform  template-free  drilling 
and  routing  operations.  We  have  developed  the  sensor  concepts  to  improve 
the  accuracy  of  the  robot.  The  first  concept  uses  six  accelerometers  to  sense 
the  six  parameters  describing  the  position  of  a  body  in  space.  As  the  robot 
moves,  each  accelerometer  will  have  its  acceleration  data  double  integrated  to 
determine  the  current  position  and  orientation  of  the  robot  from  a  reference 
position.  The  position  and  orientation  is  compared  with  the  programmed  po- 
sition and  orientation  of  the  robot  for  that  moment  to  find  the  appropriate 
amount  of  correction  needed,  the  computer  then  transforms  the  amount  of 
correction  into  corrective  motions  of  the  robot,  thereby  reducing  the  position 
error....  [6]  pp  44-45. 

In  addition,  another  aircraft  manufacturer  has  installed  a  large  gantry  type  robot 
to  perform  "Templateless  Robotic  Drilling  of  Complex  Aerospace  Assembhes,"  [7].  It  is 
evident  that  templateless  manufacturing  is  definitely  being  pursued  by  the  giants  of  the 
aircraft  industry.  However,  the  large  tolerances  of  up  to  -f/-  0.030  inch  (0.76  mm)  limit 
the  number  of  applications,  unless  additional  techniques  are  used  to  reduce  the  tolerances. 
What  causes  these  tolerances  to  be  so  great  on  current  templateless  methods? 

First,  by  examining  the  metal  removal  process,  whether  it  be  milling,  grinding  or 
drilling,  a  partial  explanation  will  be  evident.  During  any  metal  removal  operation,  forces 
are  produced  by  the  interaction  of  the  workpiece  and  the  tool.  For  some  operations,  the 
forces  can  be  quite  large.  In  this  work,  the  discussion  will  be  limited  to  cutting  forces  as 
they  relate  to  edge  milling,  but  similar  effects  are  seen  during  the  other  metal  removal 
applications  mentioned  earlier.  A  detailed  description  of  cutting  mechanics  can  be  found 
in  Chapter  4. 

The  average  cutting  force  is  proportional  to  the  metal  removal  rate  (MRR).  For  typical 
robotic  edge  milling  operations,  forces  on  the  order  of  0  to  50  pounds  (0  to  224  N)  can 
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be  encountered.  Because  all  structures  are  flexible,  including  robots,  the  applied  cutting 
forces  result  in  unwanted  displacements  at  the  end  effector,  and  if  the  deflections  are  not 
compensated  for,  errors  in  the  workpiece  are  the  result.  For  the  T3-776  robot,  uncorrected 
deflections  of  over  0.10  inch  (2.5  mm)  could  result  when  forces  equal  to  the  rated  capacity 
of  the  robot,  150  pounds,  (667  N)  were  applied.  Techniques  which  eliminate  errors  due  to 
flexibilities  of  the  cutting  forces  must  be  implemented. 

There  are  two  distinct  characteristics  associated  with  the  cutting  forces  generated 
during  edge  milhng: 

1.  The  flexibilities  of  the  robot  are  position  dependant,  thus  as  the  robot  moves  along 
its  desired  trajectory,  the  flexibility  of  the  structure  changes. 

2.  The  stock  to  remove  (flash)  varies  because  the  rough  shape  of  the  workpiece  was 
only  approximately  produced  by  shearing,  thus  the  cutting  forces  change  as  the 
robot  moves  along  its  path. 

If  the  cutting  force  or  the  flexibility  of  the  robot  remained  constant  during  the  milling 
operation,  the  problems  associated  with  structural  flexibilities  would  be  greatly  simplified. 
This  is  not  the  case;  however,  and  the  effects  of  flexibilities  must  be  taken  into  account. 

The  displacement  at  the  tool  can  be  accurately  predicted  if  the  applied  cutting  forces 
and  structural  flexibilities  are  known.  Symbolically,  the  deflection  at  the  tool,  Tdeji  can 
be  expressed  as: 

Tdefi  =  [FLEX]{Force}  (1.1) 

where  [FLEX]  denotes  the  position  dependant  flexibility  matrix  of  the  robot,  and  {Force} 
is  the  applied  cutting  force.  Because  the  cutting  force  varies  as  the  flash  varies,  the  cutting 
forces  must  be  monitored  in  real  time  for  proper  deflection  compensation.  In  a  similar 
manner,  the  position  dependant  flexibility  matrix  must  be  updated  continuously. 

Stern  [8]  provided  a  detailed  model  of  the  flexibility  characteristics  of  the  Cincinnati 
Milacron  T3-776  robot  used  in  this  research.     The  model  was  derived  using  dynamic 
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modeling  methods.  Sklar  [9]  modeled  the  same  type  of  robot  using  static  measurement 
techniques,  and  the  flexibility  model  of  the  T3-776  robot  closely  match  Stern's  work. 

By  incorporating  a  force/torque  dynamometer  at  the  wrist  of  the  robot,  the  cutting 
forces  could  be  monitored  in  real  time.  By  multiplying  the  position  dependant  flexibility 
matrix  of  the  robot  and  the  measured  forces/torques,  the  displacement  of  the  tool  could 
be  accurately  predicted  in  real  time.  This  method  of  determining  the  displacement  of  the 
tool  is  described  in  detail  in  Chapter  4. 

Once  the  displacement  of  the  tool  is  predicted,  a  method  for  compensating  must  be 
established.  Three  methods  of  compensation  were  considered: 

1.  Command  the  robot  to  provide  the  corrective  motion. 

2.  Use  an  active  workpiece  fixture  so  that  corrective  motions  can  be  commanded  of  the 
workpiece  rather  than  the  tool. 

3.  Incorporate  an  active  end  eifector,  so  that  corrective  motions  can  be  commanded 
directly  to  the  tool. 

The  first  method  seems  the  most  practical  at  first  glance,  but  to  be  successful,  several 
difficult  tasks  must  occur  in  real  time.  The  computed  displacement  of  the  tool  must  be 
back  transformed  into  joint  coordinates,  the  computed  compensation  displacement  must 
be  added  to  the  original  commanded  position  of  the  joint  controller,  and  the  joint  servo 
must  respond  instantaneously.  The  back  transformation  can  be  done  rather  quickly,  and 
the  displacement  change  of  the  joint  can  be  implemented  if  knowledge  of  the  controller  is 
available  from  the  manufacturer.  However,  the  typical  response  of  the  joint  servos  is  rather 
slow,  in  the  case  of  the  shoulder  and  elbow  bandwidths  are  on  the  order  of  1  Hz.  Thus, 
this  method  of  providing  the  necessary  compensation  displacement  was  not  pursued. 

The  second  compensation  technique  incorporates  an  active  fixture.  The  fixture  would 
move  the  required  amount  to  eliminate  the  error  of  the  tool.  This  method  of  compensation 
has  two  major  advantages  over  the  previous  method,  the  compensation  displacements  do 
not  have  to  be  back  transformed  to  robot  joint  coordinates,  and  a  dedicated  controller 
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could  be  used  to  command  motions  of  the  fixture.  However,  two  disadvantages  arise,  the 
first  being  that  up  to  six  degrees-of-freedom  would  be  required  for  the  fixture  depending 
on  the  complexity  of  the  workpiece.  Secondly,  for  large  or  heavy  workpieces,  powerful 
servos  would  be  required,  greatly  increasing  the  cost  of  the  system. 

The  final  compensation  technique  utilizes  a  single  degree-of-freedom  active  end  effector. 
By  orienting  the  motion  of  the  device  to  be  normal  to  the  desired  trajectory  of  the  tool, 
the  displacement  errors  of  the  tool  can  be  eliminated.  The  active  end  effector  would  have 
the  following  attributes: 

•  High  resolution  motion. 

•  High  bandwidth  of  operation. 

•  Compact,  self  contained  device. 

•  Includes  a  dedicated  controller  which  calculates  the  necessary  corrective  displace- 
ment. 

A  single  degree-of-freedom  active  end  effector  was  actually  built  and  used  for  the 
flexibility  compensation.  A  complete  description  of  that  device  can  be  found  in  Chapter  3. 

Straight  Line  Performance 

In  addition  to  errors  caused  by  structural  deflections  of  the  robot,  straight  line  motion 
errors  were  substantial.  For  a  typical  commanded  motion  of  the  tool  along  a  straight  path, 
deviations  of  -|-/-  0.015  inch  (0.38  mm)  were  common.  These  deviations  from  the  straight 
line  motion  must  be  eliminated  or  substantially  reduced  before  high  precision  motions  of 
the  tool  can  be  effectively  produced. 

In  general,  straight  line  motions  of  the  robot  are  representative  of  most  desired  smooth 
motion  of  the  robot.  For  many  experiments,  straight  line  motions  have  the  distinct  ad- 
vantages over  other  types  of  smooth  motions  (curved  motions  for  example)  in  that  they 
are  much  simpler  to  program,  and  records  of  the  motion  are  easier  to  obtain.    Thus  by 
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developing  methods  which  improve  the  straight  line  motion  of  the  end  effector,  smooth 
motions  in  general  may  be  enhanced. 

There  are  many  factors  which  affect  the  straight  line  motion  of  the  end  effector,  in- 
cluding: kinematic  factors,  measurement  factors  and  computational  factors.  Each  of  these 
factors  contributes  to  the  errors  at  the  end  effector,  but  in  many  cases  it  is  difficult  to 
separate  the  effect  of  each  factor  and  compensate  individually.  So  these  sources  of  error 
were  compiled  to  a  single  group  of  those  factors  which  affect  the  straight  line  motion  of 
the  robot. 

For  the  straight  line  compensation  scheme  developed,  knowing  the  cause  of  the  error 
was  not  necessary.  However,  the  magnitude  of  the  normal  displacement  of  the  tool  was 
required  so  that  it  could  be  accurately  eliminated.  For  example,  if  the  displacement  error 
was  either  directly  measured  or  observed,  the  value  could  be  eliminated  by  one  of  the 
compensation  methods  mentioned  previously. 

The  compensation  scheme  could  incorporate  either  an  open  or  closed  loop  architecture. 
For  the  closed  loop  method,  where  the  normal  displacement  is  measured,  all  deflection 
errors  could  be  eliminated.  This  could  be  done  in  a  number  of  ways,  but  the  results 
are  the  same,  if  the  actual  positional  error  can  be  measured,  then  all  deflection  errors, 
regardless  of  their  source,  can  be  eliminated.  However,  these  methods  are  impractical  for 
one  reason  or  another,  so  an  open  loop,  or  relative  compensation  scheme  was  introduced. 

The  open  loop  or  relative  compensation  technique  may  incorporate  various  sensors 
and  methods  to  provide  an  estimate  of  the  normal  displacement  of  the  tool.  The  method 
involved  using  an  accelerometer,  double  integrating  its  output,  and  using  that  informa- 
tion for  straight  line  motion  compensation.  This  method  will  be  described  in  detail  in 
Chapter  5. 

Dynamic  Compensation 

•Dynamic  compensation  is  a  closely  related  topic  to  the  area  of  improving  the  motion 
of  the  end  effector  of  the  robot.    For  the  particular  task  of  edge  milling,  the  dynamic 
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performance  of  the  robot  is  not  a  major  factor.  In  most  edge  milling  operations,  the 
robot  is  programmed  to  traverse  along  the  path  at  approximately  5  to  15  inch/min  (127 
to  381  mm/min).  For  these  relatively  low  speeds,  and  relatively  low  mass  of  the  router 
and  holder,  the  dynamic  response  of  the  robot  does  not  change  significantly. 

In  other  applications,  where  the  robot  is  either  commanded  to  move  quickly  or  carry 
heavy  loads  or  both,  the  dynamic  affects  can  be  significant.  For  example,  observing  the 
base  axis  of  the  T3-776  robot,  depending  on  the  position  of  the  end  effector,  the  inertial 
load  at  the  crown  gear  can  vary  in  a  ratio  of  12:1.  Without  providing  some  type  of 
compensation,  the  dynamic  response  of  the  base  could  vary  significantly. 

Thus,  various  methods  to  improve  the  dynamic  response  of  the  servo  systems  were 
investigated.  For  several  years,  researchers  have  attempted  to  develop  real  time  torque 
control  strategies  for  robots  instead  of  the  traditional  method  of  position  control.  By 
using  a  torque  control  strategy,  the  dynamic  motion  of  the  manipulator  would  be  closely 
controlled,  instead  of  the  current  problem  of  how  to  predict  the  motion  of  the  robot  when 
positional  control  methods  are  employed. 

However,  several  problems  are  encountered  in  the  torque  control  method.  The  com- 
plexity of  dynamic  torque  control  is  seen  in  the  following  equation: 

n  n       n 

ri^aiiqii+     Y^    aijQj  +  J^'^biji.qjqk  +  Ci  +  diqi  (1.2) 

where 

n  =  joint  number 

qi  —  position  of  joint  i 

qi  =  velocity  of  joint  i 

qi  -  acceleration  of  joint  i 

Ti  —  the  drive  torque  at  joint  i 

an  —  the  effective  inertia  at  joint  % 

aij  —  the  coupled  inertia  between  i  and  j 

bijk  =  the  Coriolis  coefficient  (j  /  k)  and  the  centripetal  coefficient  (j=k) 

Cj-  =  the  gravity  force  at  joint  i 
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di  =  the  viscous  friction  coefficient  for  joint  i 

It  is  apparent  by  the  above  equation  that  a  robot  is  a  multiple  input,  multiple  output 
system  described  by  a  set  of  coupled,  nonlinear  differential  equations,  [10].  Many  of  the 
variables  found  in  the  above  equation  are  difficult  to  quantify.  For  example,  calculating  the 
inertia  of  a  particular  link  (or  joint)  is  difficult,  but  it  must  be  known  accurately  if  torque 
control  is  to  succeed.  The  friction  coefficient  di  is  a  term  that  many  researchers  ignore 
completely,  but  it  can  be  one  of  the  most  influential  terms  for  robots  which  incorporate 
high  gear  ratios.  This  is  another  term  which  is  difficult  to  directly  quantify. 

Typically,  most  robot  manufacturers  simplify  the  above  equation,  resulting  in  a  set  of 
uncoupled  linear  equations  with  the  following  form: 

Ti  =  auqu  +  Ci  (1.3) 

The  coefficients  an  and  c,-  are  considered  position  independent  and  the  servo  system  can 
be  optimized  to  meet  a  certain  set  of  fixed  conditions,  ignoring  the  time  and  position 
dependant  variables.  For  example,  the  robot  manufacturer  may  optimize  the  response  of 
the  robot  so  that  it  provides  a  critically  damped  response  for  a  median  inertial  load,  where 
the  inertial  load  is  dependant  on  the  position  of  the  robot  and  any  mass  carried  by  the 
end  effector. 

For  inertial  loads  less  than  this  median  value,  overshoots  in  response  to  commanded 
inputs  would  result.  Conversely,  for  inertial  loads  greater  than  that  median  inertia,  the 
response  would  be  slower  and  more  sluggish  than  wanted,  because  the  system  is  over 
damped.  By  assuming  a  linear  system,  and  using  linear  control  methods,  the  response  of 
the  system  can  be  highly  non-uniform. 

As  mentioned  previously,  researchers  have  attempted  to  use  torque  control  schemes  to 
improve  the  motion  at  the  end  effector.  For  specific  motions  of  the  robot,  the  detrimental 
effects  of  the  time  varying  inertial  loads  could  be  eliminated  or  reduced  if  the  load  torque 
sensed  by  the  actuator  could  be  predicted  and  corrected  for.  If  an  accurate  dynamic  model 
of  the  robot  could  be  produced,  then  by  accurately  measuring  various  parameters  (link 
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position,  velocity  and  acceleration),  the  estimated  load  torque  could  be  used  in  a  feed 
forward  compensation  scheme. 

However,  for  typical  serial  mechanisms  with  six  degrees-of- freedom,  the  torque  equa- 
tions become  unwieldy  and  put  a  heavy  computational  burden  on  the  control  computer, 
which  make  them  difficult  to  apply  in  real  time.  Additionally,  estimating  the  various  pa- 
rameters required  for  the  dynamic  model  is  a  complex  and  time  consuming  task.  Until 
recently,  an  accurate  dynamic  model  required  disassembly,  careful  measurements  and  then 
re-assembly  of  the  manipulator.  New  methods  have  been  devised  which  allow  dynamic 
modeling  to  performed  without  disassembly,  [11]. 

A  new  method  has  been  devised  which  provides  a  direct  method  of  observing  the  actual 
load  torque  sensed  by  the  motor  without  having  to  produce  a  detailed  dynamic  model  of 
the  robot  or  implementing  complex  dynamic  equations  of  motion  in  the  controller.  This 
method  requires  an  accurate  model  of  the  motor,  where  the  parameters  are  time  and  po- 
sition invariant.  The  parameters  of  the  motor  are  typically  supplied  by  the  manufacturer, 
but  if  not,  they  are  relatively  easy  to  obtain  by  making  a  few  simple  measurements.  In  fact, 
this  method  of  observed  dynamic  compensation  can  be  applied  using  simple  analog  cir- 
cuits, which  greatly  reduce  implementation  costs.  This  method  of  dynamic  compensation 
will  be  described  in  detail  in  Chapter  2. 

The  original  reason  that  these  compensation  methods  were  developed  was  to  provide 
template  free  edge  milUng  of  sheet  metal  components  by  robots.  However,  these  com- 
pensation techniques  are  useful  for  a  number  of  other  applications  including  grinding, 
deburring,  drilling  and  inspection  tasks.  By  developing  and  implementing  these  compen- 
sation schemes,  robots  which  were  previously  limited  by  their  accuracy  could  be  used  for 
a  number  of  new  and  more  difficult  applications. 


CHAPTER  2 
IMPROVING  THE  DYNAMIC  RESPONSE  OF  THE  ROBOT  SERVO  CONTROLLER 


In  this  section,  several  topics  will  be  covered  including  a  basic  tutorial  on  the  operation 
of  a  permanent  magnet  DC  servomotor  and  a  Pulsed  Width  Modulated  (PWM)  amplifier, 
effects  of  end  effector  position  on  the  inertial  load  of  the  shoulder  axis,  an  introduction 
to  various  methods  of  providing  dynamic  compensation,  a  spring/mass  model  of  robot 
structure  as  related  to  the  base  joint,  a  model  of  the  base  axis  of  robot  and  its  simulated 
model  and  the  effects  of  implementing  a  dynamic  compensation  scheme  on  the  base  axis. 

Background  on  Dynamic  Compensation  of  Manipulators 

Presently,  the  dynamic  behavior  of  industrial  robots  with  constant  parameter  con- 
trollers cannot  provide  optimal  control  over  the  entire  robot  work  volume  due  to  the 
changes  in  external  loads  torques  sensed  by  the  motor.  For  some  load  torque,  each  servo 
in  the  robot  will  provide  an  optimal  response,  but  as  the  load  torque  changes  the  response 
will  vary.  Most  servo  controlled  manipulators  currently  utilize  linear  feedback  compensa- 
tion to  control  the  position  of  each  joint  independently.  This  is  not  sufficient  for  dealing 
with  the  dynamic  coupling  between  the  joint  motions  which  are  non-linear  and  result  from 
ever  changing  system  configurations,  gravity  and  other  external  loads.  To  compensate  for 
these  system  non-linearities,  several  torque  compensation  schemes  have  been  developed 
to  predict  the  actuator  torques  for  given  specific  motions.  Unfortunately,  some  of  these 
schemes  put  a  heavy  computational  burden  upon  the  control  computer,  which  make  them 
extremely  difficult  to  apply  in  real  time. 

For  a  given  desired  motion  of  the  robot  end  effector,  the  required  joint  torques  could 
theoretically  be  calculated  and  then  commanded  to  the  joint  controllers  and  the  correct 
motion  be  obtained.  However,  these  complicated  dynamic  models  require  accurate  in- 
formation of  the  robot  including  exact  link  geometry,  and  the  mass  and  location  of  the 
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center-of-mass  for  each  link.  In  addition,  position,  velocity  and  acceleration  of  each  link 
must  be  accurately  monitored  or  observed  in  real  time.  In  many  instances,  the  man- 
ufacturer does  not  have  the  necessary  modeling  information.  As  mentioned  previously, 
accurately  modeling  the  mass  and  the  location  of  the  center-of-mass  of  a  link  required 
that  the  robot  be  disassembled  and  carefully  measured  [12].  A  new  technique  by  Atkeson 
[11]  allows  the  modeling  of  inertial  parameters  to  occur  by  measuring  the  torque  of  the 
actuators  for  several  known  motions. 

There  are  two  methods  which  are  used  to  produce  these  dynamic  equations  of  motion, 
the  Newton-Euler  formulation  and  the  Lagrangian  formulation.  The  Newton- Euler  equa- 
tions are  founded  on  the  principles  of  Newton's  Second  Law  of  Motion,  which  describes 
dynamic  systems  in  terms  of  force  and  momentum.  These  equations  incorporate  all  the 
forces  and  moments  acting  on  each  link.  In  the  Lagrangian  formulation,  the  system's 
dynamic  behavior  is  described  in  terms  of  work  and  energy  using  geireralized  coordinates. 
Both  methods  result  in  the  same  dynamic  equation. 

To  illustrate  the  complexity  of  the  dynamics  of  a  serial  manipulator,  the  actuator 
torque  equation  is  given  below: 

T.  =  [Au]qi  +  [A^j]q^  +  [Bij]m,  +  [C^jk]qiqJ  +  D,  +  Ei  (2.1) 

where 

Ti  -  the  drive  torque  vector  at  joint  i 

qi  -  the  position  of  joint  i 

[An]  -  the  effective  inertia  matrix  for  joint  i 

[Aij]  -  the  coupled  inertia  matrix  between  joint  i  and  j 

[Bij]  -  the  coefficient  matrix  of  the  centripetal  forces 

[Cji-j  -  the  coefficient  matrix  of  the  Coriolis  forces 

Di  '  the  vector  of  gravitational  forces 

Ei  -  the  vector  of  externally  applied  forces  at  the  end  effector 
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Thus,  it  is  obvious  that  the  robot  is  a  multiple  input,  multiple  output  system  and  can 
be  described  by  i  non-linear,  coupled  differential  equations.  Note  that  frictional  effects 
were  also  neglected  in  the  above  equation.  In  the  design  of  control  systems  for  most 
existing  commercial  robots,  the  dynamic  Equation  2.1  is  simplified  by  neglecting  all  the 
terms  except  for  the  fixed  inertia  matrix  [An]  and  the  gravitational  force  vector,  £>,-.  This 
results  in  the  following  linear  equation: 

T^  =  [Au]q^  +  A  (2.2) 

This  equation  can  be  divided  into  a  set  of  i  uncoupled  linear  equations.  With  this  simpli- 
fication, the  set  of  coefficients  in  [An]  and  D,-  are  considered  position  independent,  thus, 
classical  linear  control  theory  can  be  used  to  design  the  servo  controllers.  Desired  dynamic 
behavior  can  only  be  obtained  in  a  small  region  of  the  robot's  work  envelope  because  the 
physical  system  does  not  ignore  the  coefficients  which  were  eliminated  from  Equation  2.1. 
Presently,  virtually  all  robot  controllers  are  decoupled  and  have  fixed  control  coefficients. 

Practical  experience  with  robots  that  utilize  these  simplified  linear  controllers  point  out 
the  inadequate  behavior  of  the  dynamic  responses  mainly  attributed  to  neglected  terms 
in  Equation  2.1.  Unstable  behavior  can  occur  in  extreme  conditions,  especially  when  the 
robot  is  heavily  laden  and  the  resonant  frequency  of  the  robot  approaches  that  of  the 
servomotor  bandwidth.  The  assumption  of  time  or  position  invariance  is  too  coarse  an 
assumption  for  many  applications. 

An  example  of  the  varying  inertial  loads  for  a  typical  industrial  robot  is  given  below. 
A  complete  structural  dynamic  analysis  was  performed  on  a  Cincinnati  Milacron  T3-776 
robot,  (refer  to  Stern  [8]),  and  the  resulting  mass  model  is  shown  in  Figure  2.1. 

As  stated  earlier,  the  linear  uncoupled  controller  which  is  used  to  control  most  robots, 
provides  optimal  dynamic  response  for  a  limited  range  of  the  robot's  work  volume.  But  as 
will  be  shown  now,  the  inertial  load  for  the  first  axis  changes  in  a  ratio  12:1  depending  on 
the  position  of  the  robot's  wrist.  This  does  not  include  the  inertial  effects  of  any  externally 
applied  loads.  If  ©3  equals  150  degrees,  (maximum  for  joint  3)  and  ©2  equals  90  degrees, 
then  the  total  inertial  load  due  to  the  masses  of  the  robot  structure  depicted  in  Figure  2.2 
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Figure  2.1:  Mass  Model  of  the  T3-776  Robot  (Adapted  From  [8]) 
can  be  found  with  the  following  equation: 

Itot      =       Ml  */iCOs(^2)-/2COs(^3-^2)  +  M2*/2COS(e2)+  (2.3) 

Ms  +  /a  cos(6'2)  +  h  cos(6l3  -  62) 

(2.4) 

where 

h  -  44  in  (1.1  m) 

h  =  16  in  (0.43  m) 

I3  =  55  in  (1.5  m) 

Ml  =  1.024  lb  sec'^/in  (177.7  N  sec'^/m) 

M2  =  0.525  lb  sec'^/in  (91.1  N  sec^/m) 

Ads  ^  0.878  lb  sec'^/in  (152.3  N  sec^jm) 


Using  the  above  equation,  the  total  inertia  is  equal  to  729.5  in  *lb*  se(?  (83.2  N  *m* 
sec^).  This  is  approximately  the  minimum  inertial  load  for  the  base  axis.  If  new  values 
are  selected  for  ©2  and  63,  a  near  maximum  inertial  load  can  be  calculated.  Letting  02 
equal  30  degrees  and  63  equal  150  degrees,  the  configuration  depicted  in  Figure  2.3  is 
produced. 

Again  using  the  above  equation,  the  inertial  loads  is  calculated  as  8872.6  in  *  lb  *  sec? 
(1011  N  *  m  *  sec^)  for  this  configuration.    Indeed,  a  12:1  ratio  was  found  between  the 
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Figure  2.2:  Minimum  Inertial  Position  of  Base  Axis  of  T3-776 


Figure  2.3:  Maximum  Inertial  Position  of  Base  Axis  of  T3-776 
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Figure  2.4:  Response  of  Single  Degree-of- Freedom  Manipulator  to  Various  Damping  Ratios 


extreme  inertial  loads  for  the  base  axis,  and  this  ratio  could  become  even  greater  if,  for 
example,  there  was  a  large  mass  being  carried  by  the  gripper. 

From  this  simple  exercise,  it  is  obvious  that  to  ignore  the  position  dependant  terms  in 
the  dynamic  equations  of  motion  could  have  undesirable  effects  on  the  robot  motion.  This 
demonstration  addresses  only  the  inertial  terms  and  not  the  cross  coupling,  centripetal, 
Coriolis,  gravitational,  or  external  force  coefficients.  Depending  on  the  velocity  and  config- 
uration of  the  manipulator,  these  terms  could  be  significant  and  further  limit  the  dynamic 
capabilities  of  the  robot. 

To  illustrate  the  effects  of  external  torque  disturbances  in  the  form  of  varying  inertial 
loads,  a  simple  example  will  be  given  using  a  single  degree-of-freedom  manipulator.  For  a 
single  degree-of-freedom  manipulator,  there  are  obviously  no  cross  coupling  terms  in  the 
dynamic  equation  of  motion;  however,  the  inertial  load  perceived  by  the  servomotor  can 
be  changed  by  attaching  various  masses  to  the  end  of  the  manipulator. 

With  the  servo  described  as  a  second  order  system,  and  a  fixed  inertial  load  attached 
to  the  manipulator,  the  feedback  gains  can  be  adjusted  so  tlie  servomotor  is  critically 
damped.  This  provides  quick  response  to  a  setpoiiit  without  overshoot,  as  seen  in  (a)  in 
Figure  2.4.  For  the  same  system,  but  with  an  increased  inertial  load,  the  response  of  the 
system  will  be  more  sluggish  and  take  a  greater  time  to  reach  the  desired  output,  as  seen 
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in  (b)  in  Figure  2.4,  this  also  indicates  an  overdamped  system.  If  the  inertia  was  reduced 
instead,  the  system  would  become  underdamped  resulting  in  overshoot  as  seen  in  (c)  in 
Figure  2.4. 

This  type  of  response  is  sometimes  observed  on  typical  industrial  robots,  especially 
when  heavy  objects  are  grasped  or  the  inertial  load  of  a  particular  joint  is  affected  by 
the  position  of  the  end  effector.  In  many  industrial  applications,  robots  are  expected  to 
do  this  type  of  procedure  constantly  when  doing  pick  and  place  operations.  In  fact,  the 
effects  may  be  more  pronounced  when  the  cross  coupled  velocity  related  terms  are  included 
during  the  high  speed  operation  of  the  manipulator. 

The  dynamic  behavior  of  a  robot  can  be  defined  as  the  time  rate  of  change  of  the  robot 
arm  in  relation  to  the  joint  torques  exerted  by  the  actuators.  To  achieve  the  dynamic 
behavior  required  of  high  speed,  accurate  manipulation  tasks,  it  is  intuitive  that  the 
varying  dynamic  behavior  just  depicted  may  cause  errors  in  the  desired  motion  of  the 
robot.  But  for  all  linear  type  robot  controllers,  variation  in  the  dynamic  response  of  the 
system  is  typical.  Thus,  one  may  conclude  that  the  step  response  of  a  linearly  controlled 
servo  system  to  various  inertial  loads  are  different,  and  in  turn  affect  the  overall  dynamic 
response  of  the  robot.  To  provide  a  repeatable  response  even  when  various  loads  are 
applied,  alternative  feedback  strategies  have  to  be  imposed. 

To  understand  the  dynamic  various  compensation  methods,  an  introduction  to  the 
operation  of  permanent  magnet  DC  motors  and  Silicon  Controlled  Rectifier  (SCR)  con- 
trollers would  be  useful.  In  the  next  section,  a  brief  overview  of  the  operation  of  typical 
position  controlled  servo  systems  will  be  discussed. 

Introduction  to  the  Operation  of  a  Permanent  Magnet  DC  Motor  and  SCR  Controllers 

There  are  two  basic  types  of  DC  motors,  those  with  electromagnetic  fields  and  those 
with  permanent  magnet  fields.  Most  electric  industrial  robots  like  the  Cincinnati  Milacron 
T3-776  utilize  permanent  magnet  DC  servomotors,  so  this  discussion  will  be  limited  to 
motors  of  this  type. 
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Figure  2.5:  Torque/Speed  Curve  for  a  Typical  Permanent  Magnet  DC  Motor 


Since  the  stater  magnetic  field  of  permanent  magnet  DC  motors  is  generated  by  per- 
manent magnets,  no  power  is  used  in  the  field  structure.  Because  no  power  is  required 
to  generate  the  stator  ma,gnetic  flux,  the  efficiency  of  a  permanent  magnet  DC  motor  is 
greater  than  that  of  electromagnetic  field  DC  motors.  Since  the  conversion  of  electrical  to 
mechanical  power  takes  place  in  the  armature  windings,  the  power  supplied  to  the  field 
windings  results  in  mostly  heat  loss  in  the  winding  itself.  Thus,  permanent  magnet  motors 
reduce  power  requirements  while  also, introducing  less  heat  to  the  system  [13]. 

Because  the  stator  magnetic  flux  remains  essentially  constant  at  all  levels  of  armature 
current,  the  speed-torque  curve  of  a  permanent  magnet  motor  remains  constant  over  an 
extended  range,  see  Figure  2.5.  With  modern  ceramic  magnets,  the  stalled  torque  will 
tend  to  be  higher  and  the  speed-torque  curve  will  tend  to  be  more  linear  than  for  a  field 
wound  motor.  This  greatly  simplifies  the  control  architecture,  as  will  be  seen  shortly. 

Another  benefit  of  the  permanent  magnet  DC  motor  is  a  reduced  frame  size  for  a 
given  power  output.  Because  of  the  high  coercive  strength  of  permanent  magnets,  their 
radial  dimension  is  typically  one-forth  that  of  a  field  wound  motor  [13].  The  benefits  of  a 

permanent  magnet  motors  over  a  field  wound  motors  are  summarized  as  follows: 

•  Linear  torque-speed  characteristics 

•  High  stall  torque 
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Figure  2.6:  Equivalent  Circuit  of  a  Permanent  Magnet  DC  Motor 

•  No  power  loss  or  heat  gains  from  electromagnetic  flux  generator 

•  Smaller  frame  and  lighter  motor  for  required  output 

The  description  of  the  motor  equations  start  with  the  relationship  between  the  elec- 
trical variables.  An  accurate  model  of  the  motor  is  required  to  reveal  the  origin  of  some 
of  these  variables.  Figure  2.6  provides  the  equivalent  circuit  of  a  permanent  magnet  DC 
motor.  The  impedance  at  stall  is  equal  to  a  resistance  R,  in  series  with  a  parallel  combi- 
nation of  L  and  another  resistance  Ri.  The  physical  explanation  for  this  model  is  that  Ri 
represents  the  losses  of  the  armature  windings,  L  is  the  inductance  found  in  the  armature 
windings  and  R  is  due  to  other  losses,  brushes  for  example.  The  resistance  of  the  armature 
windings,  Ri  is  usually  larger  than  R,  approximately  10  times  larger,  thus  the  effect  of  Ri 
on  the  operation  of  the  motor  is  insignificant  and  will  be  neglected  from  this  point. 

As  the  armature  rotates  in  the  stator  magnetic  field,  internally  generated  electromotive 
forces  appear  across  the  armature  terminals.  The  induced  force  is  known  to  most  as  the 
counter  emf,  represented  as  Eg.  The  supplied  motor  voltage  and  current  will  be  denoted 
as  V  and  /,  respectively.  The  relation  between  these  variables  can  be  represented  by  the 
following  equation: 


F  =  4  +  «/+£, 


(2.5) 
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where  Eg,  the  back  emf  is  proportional  to  the  the  motor  velocity  u. 

Eg  =  K,io  (2.6) 

These  equations  can  be  combined  to  provide  the  electrical  equation  of  the  motor: 

V  =  L^+Rl+Keu  (2.7) 

Because  the  magnetic  field  in  a  permanent  magnet  motor  remains  constant,  the  motor 
current  /  produces  a  proportional  torque  output,  T^: 

Tt  =  Kt  *  I  (2.8) 

The  torque  constant,  Kt-,  provided  by  the  motor  manufacturer,  is  used  in  calculating 
the  total  torque  output  of  the  motor,  Tt.  The  rotating  components  of  the  motor  have 
a  corresponding  inertia,  J.  The  torque  required  to  accelerate  J  will  be  defined  by  the 
following  equation: 

Tm  =  J^  (2.9) 

Additional  torque  loads  seen  by  the  motor  include  a  constant  friction  term  T/,  viscous 
friction  and  windage  losses,  Du),  which  are  proportional  to  the  motor  velocity,  and  any 
additional  loads  seen  by  the  motor  due  to  external  loads,  Te.  These  additional  loads  will 
be  lumped  into  a  single  term  T/  and  their  relationships  will  be  expressed  as  follows: 

Ti^Du  +  Tj  +  T,  (2.10) 

The  relationship  between  the  torques  and  motor  velocity  can  be  seen  in  the  following 

equation: 

^        ^du       ^         ^       ^  ,        s 

Tt=-J—  +  Dio  +  Tf  +  Te  (2.11 

at 

or  simplified  as: 

Tt  =  Tm  +  Ti  (2.12) 

With  equations  2.7,  2.8  and  2.1  the  relationship  between  the  electrical  and  mechanical 
variables  are  described.    With  these  equations,  the  transfer  function  between  the  motor 
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voltage  and  the  corresponding  motor  velocity  can  be  established.  For  the  initial  discus- 
sion, the  following  variables  will  be  set  to  zero:  Tj  —  0  and  1}  =  0.  Applying  Laplace 
transformations,  the  motor  equations  can  be  re-written  as: 

V{s)  =  {Ls  +  R)I{s)  +  Keio{s)  (2.13) 

Ttis)  =  KJ{s)  (2.14) 

Tt{s)  =  J,Lj(s)  +  Duj{s)  (2.15) 

The  motor  current,  /,  can  now  be  expressed  as: 

T(s)  =  ~iJs  +  D)Lo(s)  (2.16) 

and  can  be  substituted  into  equation  2.13  to  form 

V{s)  =  ^{Ls  +  R){Js  +  D)u{s)  +  K,u{s)  (2.17) 


The  corresponding  transfer  function  is 


(2.18) 


V{s)       {Ls  +  R){Js  +  I?)  +  KJU 
The  above  transfer  function  has  two  poles,  which  are  the  roots  of  the  characteristic  equa- 
tion or  the  denominator.  The  characteristic  equation  can  be  re-written  as  follows: 

LJs^ +  {LD  +  RJ)s  +  RD  +  KJ{t  =  ^  (2.19) 

By  making  the  valid  assumption  that  the  motor  damping  factor,  D  is  equal  to  zero 
and  that  the  motor  inductance  is  small, [13]  the  transfer  function  can  be  simplified  and  be 
written  in  the  following  form: 

(^-^)(--f)  =  0  (2.20) 

where  the  poles  are  equal  to  the  inverse  of  the  respective  mechanical  r^  and  electrical 
time  constants  re.  The  transfer  function  can  now  be  written  as: 

w(5)  _  II Kt 


V{s)       (r„(5)5  +  l){Te{s)s  +  1) 


(2.21) 
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Figure  2.7:  Block  Diagram  of  a  Simplified  Permanent  Magnet  DC  Motor 


and  the  mechanical  time  constant  is  written  as: 


'  m.    — 


RJ 
KtKt 


(2.22) 


and  the  electrical  time  constant  is  equal  to: 


T.  =  — 


R 


(2.23) 


Usually  the  mechanical  time  constant  is  approximately  ten  times  greater  than  that  of  the 
electrical  time  constant.  The  electrical  time  constant  can  be  ignored  in  many  simulation 
exercises,  and  the  system  will  still  be  accurately  modeled. 

These  above  equations  help  to  express  the  physical  properties  of  an  ideal  permanent 
magnet  DC  motor,  some  simplifications  have  been  made  to  the  model.  For  further  detail, 
see  [13].  A  block  diagram  of  a  simplified  DC  motor  is  illustrated  in  Figure  2.7. 

Note  that  the  motor  velocity  is  the  value  being  controlled  here  by  the  input  volt- 
age. Most  machine  tools/robots  utilize  positional  control  loops  and  this  subject  will  be 
discussed  later  in  this  section. 

The  next  major  component  of  a  servo  system  to  be  discussed  is  the  motor  controller. 
Transistor  amplifiers  used  in  the  speed  or  torque  control  of  DC  servomotors  are  divided  into 
two  broad  categories;  linear  amplifiers  and  switching  amplifiers.  Typically,  linear  amplifiers 
are  used  for  fractional  horsepower  motors  and  switching  amplifiers  are  used  for  integral 
horsepower  motors,  motors  having  ratings  of  one  horsepower  or  more.  Because  most  large 
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Figure  2.8:  Voltage  Waveforms  in  Switching  Amplifiers  (Adapted  from  [13]) 


industrial  robots  employ  integral  horsepower  servomotors,  the  following  discussion  will  be 
limited  to  switching  type  amplifiers. 

To  create  the  large  currents  required  by  motors  of  this  type,  these  controllers  employ 
Silicon  Controlled  Rectifiers  (SCR)  otherwise  known  as  thyristors.  Switching  amplifiers 
enjoy  a  distinct  advantage  over  the  linear  amplifiers  in  that  they  more  efficient  for  large 
current  applications.  Three  basic  methods  are  used  to  control  the  power  in  switching 
amplifiers;  Pulsed  Width  Modulation  (PWM),  Pulsed  Frequency  Modulation  (PFM),  and 
SCR  controls.  Their  principal  differences  are  shown  in  Figure  2.8 

The  PWM  system  is  described  as  utilizing  a  DC  power  supply,  and  the  amplifier 
switches  the  supply  voltage  on  and  ofi"  at  a  fixed  frequency,  with  a  variable  firing  angle 
so  that  the  desired  voltage  across  the  load  is  established.    The  firing  angle  is  actually 
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Figure  2.9:  Overview  of  SCR  Controller  Operation 

related  to  the  duration  that  current  is  flowing  through  the  SCR.  The  amount  of  power 
transferred  to  the  motor  will  depend  on  the  switching  rate  and  the  load  inductance.  The 
pulse  frequency  is  usually  fixed  at  a  high  frequency,  around  1000  Hz. 

The  PFM  has  a  fixed  firing  angle  but  a  variable  firing  rate.  It  achieves  the  same  results 
as  the  PWM,  but  it  is  somewhat  harder  to  implement. 

The  SCR  circuit  for  DC  motor  control  usually  operates  from  an  AC  power  source. 
SCRs  are  different  than  typical  transistor  switching  devices  in  that  they  can  switch  much 
higher  currents,  but  once  activated,  the  SCR  passes  current  until  the  input  AC  voltage 
drops  back  to  zero.  SCR  speed  controls  are  nearly  always  based  on  the  power  line  fre- 
quency of  60  Hz.  This  somewhat  limits  the  controller  bandwidth.  However,  like  the  PWM 
controller,  the  SCR  circuit  incorporates  a  high  frequency  (1  -  10  Khz)  clock,  which  allows 
the  SCR  to  be  switched  on  with  precision. 

While  the  SCR  controller  is  limited  in  bandwidth,  it  has  a  high  power  conversion 
efficiency  due  to  its  switching  mode.  The  relative  simplicity  of  its  circuitry  adds  to  the 
positive  features  of  the  SCR  controller.  The  popularity  of  the  SCR  control  for  DC  motor 
control  in  the  integral  horse  power  range  has  been  due  to  the  above  mentioned  features. 
In  addition,  SCR  can  operate  directly  from  the  power  line  without  AC-to-DC  power 
conversion. 

Figure  2.9  provides  an  overview  of  the  velocity  control  of  a  servomotor  and  the  opera- 
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Figure  2.10:  Result  of  a  Sudden  Torque  Disturbance  on  a  SCR  Speed  Control  System 
(Adapted  from  [13]) 

tion  of  the  SCR  circuit.  A  pre-amp  takes  the  output  of  the  comparator,  properly  adjusts 
the  value  and  then  provides  an  input  to  the  SCR  circuit.  A  circuit  in  the  SCR  controller, 
denoted  SCR  Controller,  then  sends  a  command  voltage  to  the  SCR  at  the  appropriate 
time  to  provide  the  necessary  polarity  and  duration  of  the  AC  sine-wave.  Not  only  does 
this  circuit  allow  the  direction  of  the  motor  to  be  controlled,  it  also  provides  dynamic 
braking. 

An  important  problem  in  SCR  velocity  control  systems  is  the  'transportation'  lag  or 
dead  time.  This  is  caused  by  the  discrete  firing  angle  conduction  and  the  fact  that  once 
the  SCR  is  activated,  its  output  cannot  turn  off  until  the  forward  current  goes  to  zero.  For 
example,  if  the  motor  was  in  steady  state  with  a  constant  velocity  and  suddenly  torque 
disturbance  was  applied,  the  resulting  change  in  speed  could  cause  the  SCR  to  fire  'early'. 
The  results  are  simulated  in  Figure  2.10.  Note  that  this  controller  does  not  have  the 
capability  of  dynamic  braking,  it  cannot  apply  a  negative  current  to  the  motor. 

The  result  will  be  a  heavy  surge  of  power  for  the  remaining  part  of  the  half  cycle,  even 
if  the  error  signal  has  returned  to  normal  in  the  meantime.  The  motor  now  has  a  large 
over  speed  error,  and  will  coast  down  to  the  predetermined  control  speed.  This  results  in 
a  somewhat  jerky  motion  of  the  motor.  Many  of  the  larger  controllers  use  a  3  phase  AC 
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Figure  2.11:  Block  Diagram  of  a  Position  Controlled  Servo 


voltage  source,  this  in  combination  with  the  dynamic  braking  capability  greatly  improves 
the  responsiveness  of  the  SCR  controller  and  helps  to  reduce  the  jerky  motion  illustrated 
in  Figure  2.10. 

With  the  above  information,  an  accurate  model  of  the  base  axis  servo  system  of  the 
T3-776  robot  can  now  be  developed.  This  model  will  incorporate  a  Proportional  Integral 
Derivative  (PID)  controller  as  found  on  the  base  axis  of  the  T3-776,  with  positional  and 
velocity  feedback.  A  block  diagram  representation  is  seen  in  Figure  2.11.  Points  of  interest 
include  the  PID  amplifier,  the  SCR  driver,  and  the  motor.  The  constants  for  the  block 
diagram  are  defined  below: 

Kp  -  positional  feedback  gain  L  -  motor  inductance 

Ka  '  proportional  velocity  gain  R  -  motor  resistance 

T  -  integration  time  constant  Kt  -  torque  constant  of  motor 

Kscr  -  thyristor  amplifier  gain  J  -  motor  inertia 


Ke  -  internal  motor  feedback 
Ky  -  tachometer  constant 


r  -  mechanical  reduction  of  drive 
Tl  -  external  load  torque 


The  closed  positional  loop  transfer  function  of  the  above  system  can  be  written  as 
[KpKJ{scRKtP{s)  +  (1  +  Ts)iLs  +  R)Ti{s) 


9{3)  = 


{A)s^  +  (5)53  +  {C)s^  +  {D)s  +  (E) 


(2.24) 


where 
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A  =  {LTJr) 

B  =  {TR  +  L){Jr) 

C  =  (RJr  +  K.KtTr) 

D  =  {KeKtr  +  KaKscRKtKyr) 

E  -  {KpKaKsCRlQ) 

The  block  diagram  in  Figure  2.11  was  used  as  the  developmental  base  for  a  simulation 
model  of  the  actual  servo  controller  used  in  these  experiments.  The  controller  will  be 
discussed  in  further  detail  in  the  following  section,  which  is  devoted  to  modeling  techniques 
for  the  servo  controller  and  the  base  axis  dynamics. 

Development  of  the  Base  Axis  Servo  Driver  and  Motor  Model 

This  section  is  devoted  to  the  development  of  a  model  of  the  base  axis  servomotor  and 
motor  driver  of  the  T3-776  robot.  Included  are  modeling  methods  and  simulated  results  of 
the  model.  These  models  are  necessary  to  better  understand  the  operation  of  the  base  axis 
of  the  robot.  Additionally,  through  accurate  simulation,  various  dynamic  compensation 
schemes  could  be  tested  and  evaluated  before  being  actually  implemented  on  the  base  axis 
controller. 

A  robot  servo  system  can  be  broken  into  two  major  components,  the  servo  controller 
or  driver,  and  the  servomotor.  A  servomotor  can  be  quickly  and  easily  modeled  and  accu- 
rate simulations  performed  if  the  motor  characteristics  supplied  by  the  manufacturer  are 
correct.  In  fact,  most  of  the  motor  characteristics  can  be  easily  measured  if  the  necessary 
testing  equipment  is  available.  Electro-craft  [13]  details  methods  to  obtain  all  required 
motor  constants.  The  following  constants  were  provided  by  the  motor  manufacturer  for 
the  base  axis  motor  of  the  T3-776,  and  assumed  accurate: 

R  -  0.63  ohm  (includes  both  armature  and  additional  resistances) 
L  -  3.53  mH  (includes  both  motor  and  choke) 
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Figure  2.12:  Simplified  Block  Diagram  of  T3-776  Base  Servo  Loop 

Jm.  -  0.0073  ft  *  lb  *  sec'^/rad  (0.01  N  *  m  *  sec^/rad),  including  armature,  tachometer, 
brake  and  pulley  inertia 

Kt  -  0.51  Nm/A 

Ke  -  0.51  V/rad/sec 

Ky  -  0.18  V/rad/sec  (tachometer  output) 

These  values  were  used  for  the  system  simulation  program. 

Because  of  the  limited  information  supplied  by  the  servo  controller's  manufacturer, 
the  controller  had  to  be  accurately  measured  and  through  an  iterative  process  using  sim- 
ulation, the  motor  constants  were  discovered  and  verified.  The  servo  controller  is  a  PID 
type  controller  manufactured  by  Siemens  Incorporated.  The  PID  circuit  incorporates  a 
switched  gain  amplifier,  where  both  the  integral  and  proportional  gains  are  switched  from 
one  value  to  another  when  the  motor  velocity  goes  above  or  below  100  RPM.  The  PID 
pre-amplifier  circuit  drives  the  motor  amplifier,  which  has  a  rated  output  of  44  amps  at 
150  volts  [14]. 

A  simplified  block  diagram  of  the  servo  loop  is  seen  in  Figure  2.12.  Four  nodes  of 
the  actual  system  were  monitored  and  the  signals  were  recorded  in  real  time  with  a  data 
acquisition  system.  These  test  points  are  labeled  (1)  through  (4)  in  Figure  2.12.  By 
applying  various  inputs  at  node  (1),  the  response  of  the  system  could  be  analyzed  and  the 
system  parameters  could  be  estimated.  With  the  estimated  system  parameters,  the  servo 
control  loop  could  be  accurately  simulated. 
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The  first  experiment  performed  on  the  servo  system  was  one  to  determine  the  band- 
width of  the  base  aods  servo  system.  Sine  waves  of  various  frequencies  were  introduced 
to  the  input  of  the  velocity  loop,  denoted  as  node  (1)  in  Figure  2.12.  The  tachometer, 
which  provides  the  velocity  feedback  is  located  at  the  motor  and  the  positional  resolver 
for  the  base  axis  is  located  at  the  crown  gear.  By  disconnecting  the  timing  belt  between 
the  motor  and  the  gearbox,  the  positional  loop  is  opened,  while  the  velocity  loop  remains 
closed.  The  record  of  the  tachometer  output  (node  4),  showed  that  the  velocity  response 
of  the  system  dropped  off  20  db  per  decade  at  11  Hz. 

It  is  interesting  to  note  that  the  first  natural  frequency  of  the  robot  in  a  somewhat 
extended  configuration  is  approximately  10  Hz.  In  some  extreme  instances,  the  robot 
would  become  unstable  when  fully  extended  and  an  external  load  applied.  This  event 
might  be  explained  because  the  first  natural  frequency  of  the  robot  falls  within  the  velocity 
bandwidth  of  the  base  servomotor.  Most  robot  manufacturers  circumvent  this  problem  by 
requiring  the  bandwidth  of  the  servo  to  be  lower  than  the  first  natural  frequency  of  the 
robot. 

To  determine  the  gains  of  the  system,  a  step  input  was  introduced  to  the  input  of  the 
velocity  loop,  denoted  point  (1)  in  Figure  2.12  and  again,  the  signals  from  the  four  nodes 
of  interest  were  recorded  real  time.  Voltage  dividers  had  to  implemented  for  the  SCR  and 
tachometer  outputs,  nodes  (3)  and  (4),  to  prevent  saturation  of  the  GenRad  data  logger 
used  to  record  the  tests.  See  Appendix  B  for  a  complete  description  of  equipment  used. 

The  gains  in  the  PID  controller  are  difficult  to  measure  directly  because  the  velocity 
feedback  term  is  summed  with  the  commanded  input  voltage.  If  the  controller  could  be 
operated  in  an  open  velocity  loop  configuration,  the  proportional  and  feedback  gains  could 
be  determined  directly.  However,  when  the  velocity  feedback  signal  is  disconnected  and 
that  input  shorted  to  ground,  the  system  will  quickly  become  unstable  and  automatically 
shutdown.  If  the  values  of  the  various  potentiometers  in  the  circuit  could  be  directly 
measured,  the  gains  could  be  estimated  by  equations  derived  from  the  schematic.  However, 
this  would  require  that  the  potentiometers  to  be  removed  from  the  circuit  board. 
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Figure  2.13:  Schematic  of  Simple  Summing  Amplifier 

A  method  was  developed  so  that  the  proportional  input  and  feedback  gains  could  be 
estimated.  Assuming  that  the  gains  of  the  input  summing  amplifier  are  fixed,  relationships 
between  known  inputs  and  measured  outputs  of  the  amplifier  could  be  used  to  calculate 
the  input  gains.  For  the  simple  amplifier  depicted  in  Figure  2.13  the  gains  for  the  inputs, 
Gi  are  equal  to  the  ratio  of  the  feedback  resistance,  Rj  over  the  input  resistance  R^.  By 
changing  one  of  the  input  voltages,  the  difference  in  the  output  is  used  to  calculate  the 
gains.  For  example,  the  input  voltage,  /i  was  doubled,  and  the  result  is  expressed  as 
follows: 


Oi     =    /iGi+/2G'2 
O2    =    HGi  +  I2G2 
h    =    2/3 


(2.25) 
(2.26) 
(2.27) 


Making  the  proper  substitution  and  simplification,  the  gain  for  input  one,  Gi  is  equal  to: 

O1-O2 


Gi 


(2.28) 


and  then,  G2  can  be  easily  solved  for  also.  Because  the  difference  between  0\  and  O2  is 
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Figure  2.14:  Simplified  Schematic  of  the  Siemens  Amplifier  Circuit 

small,  these  gains  could  only  be  considered  approximate.  The  input  gain,  G\  vvas  equal 
to  9.16  and  the  feedback  gain  G'2  was  equal  to  -1.16. 

A  simplified  schematic  of  the  Siemens  PID  amplifier  is  presented  in  Figure  2.14  and 
shows  the  proportional  summing  amplifier  along  with  the  parallel  integrating  circuit.  The 
outputs  of  these  two  circuits  are  combined  using  an  additional  unity  gain  amplifier.  The 
output  of  this  unity  gain  amplifier  is  noted  with  the  label  (2)  in  Figure  2.12.  Items 
of  interest  in  this  circuit  include  the  switching  circuit  which  effects  a  change  in  both 
the  proportional  and  the  integration  gain  of  the  circuit  when  a  certain  velocity  feedback 
potential  is  reached. 

Because  the  values  for  a.dditional  potentiometers  in  the  circuit  are  unknown,  the  gain 
for  the  integrator  and  its  time  constant  have  to  be  approximated  and  then  verified  through 
simulation.  The  PID  controller  also  includes  a  low  pass  filter  at  the  input  for  both  the 
input  and  feedback  connections  which  have  to  be  modeled  and  included  in  the  simulation. 
This  changed  the  PI  portion  of  the  amplifier  from  a  first  order  system  to  a  second  order 
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system  and  the  change  was  included  in  the  simulation.    This  amplifier  has  a  bounded 

output  of  -12  to  +12  volts. 

To  improve  the  response  of  a  SCR  driven  servomotor,  a  small  alternating  current  is 
constantly  sent  to  the  motor,  even  when  no  motion  is  required  of  the  motor.  The  average 
current  applied  to  the  motor  is  equal  to  zero.  The  current  pulses  are  small  enough  that 
the  armature  does  not  rotate  but  large  enough  that  the  negative  effect  of  the  motor 
inductance  is  reduced.  If  the  motor  is  requested  to  turn  in  a  certain  direction,  the  PID 
amplifier  provides  the  appropriate  voltage  to  the  SCR  circuitry,  and  the  current  pulses 
increase  in  the  required  direction  and  simultaneously,  the  current  pulses  of  the  opposite 
sign  decrease.  This  results  in  an  increased  average  current  in  the  desired  direction,  causing 
torque  to  be  produced  and  acceleration  of  the  motor  in  the  proper  direction. 

A  simulation  program  was  developed  to  emulate  a  3-phase  SCR  switching  circuit. 
Initially,  the  simulated  output  did  not  correctly  correspond  with  the  actual  system.  It 
became  apparent  that  an  additional  integrator  is  used  in  the  SCR  driver  circuit.  With  the 
additional  integrator  included,  an  excellent  simulation  of  the  closed  velocity  loop  of  the 
servo  system  is  produced.  A  copy  of  this  simulation  program  can  be  found  in  Appendix  C. 
Figure  3.12  shows  the  measured  outputs  of  the  nodes  labeled  (1)  through  (4)  in  Figure  2.12, 
where  the  points  are  identified  as  follows: 

(1)  -  input  step  command  in  velocity 

(2)  -  output  of  PID  amplifier 

(3)  -  output  of  SCR  circuit 

(4)  -  tachometer  output 

Figure  2.16  shows  the  simulated  response  of  the  closed  velocity  loop  with  a  step  in- 
put. The  simulated  response  closely  resembles  the  actual  system  and  a  block  diagram 
representation  of  the  simulated  servo  system  which  produced  this  output  can  be  seen  in 
Figure  2.17.  The  simulation  includes  non-linearities  encountered  in  the  actual  system 
such  as  voltage  limits,  current  limits,  discreet  time  control  for  the  firing  of  the  SCRs,  etc. 
The  model  of  the  base  axis  velocity  loop  developed  in  the  simulation  could  then  be  used 
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Figure  2.17:  Block  Diagram  Representation  of  Base  Axis  Servo 

to  accurately  determine  the  response  of  the  base  axis  to  various  dynamic  compensation 
schemes. 

To  complete  the  simulation  of  the  base  servo,  the  positional  gain  constant,  Kp  has 
to  be  obtained.  It  was  unavailable  from  the  manufacturer  of  the  robot  and  could  not 
be  directly  measured  because  it  was  contained  in  the  digital  portion  of  the  controller.  A 
scheme  was  developed  to  iteratively  obtain  the  value  through  additional  measurements 
and  simulations. 

The  positional  loop  was  closed  by  re-attaching  the  toothed  belt  from  the  motor  to  the 
gear  box.  A  step  input  of  one  volt,  V^  was  applied  to  the  input  of  the  velocity  loop  and 
the  motor  velocity,  lj^  was  measured  by  monitoring  the  tachometer.  Figure  2.18  shows 
the  velocity  response  of  the  base  axis  to  the  step  input.  Because  the  step  input  is  not 
commanded  by  the  controUer,  it  is  perceived  by  the  system  as  a  positional  error  and  is 
eliminated  over  time.  Several  simulation  runs  were  required  before  an  accurate  match 
could  be  made  between  the  actual  and  simulated  response  of  the  servo  to  step  inputs  in 
position.  The  iterated  value  for  Kp  from  simulation  is  eciual  to  approximately  70. 

After  completing  the  model  of  the  motor  and  controller,  an  accurate  model  of  the 
robot  structure  was  needed  in  the  simulation.  The  next  section  explains  the  structural 
modeling  techniques  and  results. 
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Figure  2.18:  Velocity  Response  of  the  Base  Axis  to  a  Positional  Error  Step  Input 
Development  of  the  Structural  Dynamic  Model  of  the  Base  Axis 


This  section  is  devoted  to  devolving  a  dynamic  structural  model  of  the  base  axis  of  the 
robot.  To  achieve  an  accurate  dynamic  simulation  of  the  controller  in  the  closed  positional 
loop,  additional  information  regarding  the  robot's  structural  dynamic  response  must  be 
known.  This  response  was  obtaiiTod  by  developing  a  spring/mass  model  of  the  servomotor 
drive  system  including  the  belts,  gearboxes  and  robot  structure.  Figure  2.19  shows  a 
simplified  diagram  of  the  base  axis  drive. 

The  motor  pulley  has  a  diameter  of  4  inches,  the  gear  box  pulley  has  a  diameter  of 
7.75  inches  and  is  driven  by  a  toothed,  timing  belt.  The  gearbox  has  a  reduction  ratio 
of  13.5:1.  The  pinion  gear  is  3.25  inches  in  diameter  and  it  drives  the  crown  gear,  20 
inches  in  diameter.  OveraU,  there  is  a  reduction  of  160:1  (motor  revolutions  to  crown  gear 
revolutions). 

Measurements  were  made  with  the  robot  in  an  extended  configuration,  as  seen  in 
Figure  2.20.  Accelerometers  were  placed  on  the  robot  structure  at  the  points  labeled  1,  2, 
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Figure  2.19:  Base  Axis  Drive 


Figure  2.20:  Robot  In  Extended  Configuration  (Adapted  from  [8]) 
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Figure  2.21:  Linear  Spring/Mass/Dashpot  Representation  of  Base  Axis 

3  and  also  on  the  extreme  radius  of  the  base,  4,  the  gearbox  pulley  and  the  motor  pulley. 
At  point  1,  the  robot  was  struck  with  a  modally  tuned  hammer. 

To  excite  the  various  modes  of  vibration,  the  amplitude  of  the  impact  must  be  sufficient 
to  excite  these  natural  frequencies  of  the  robot.  To  facilitate  this  requirement,  a  large  mass 
(5  Kg)  was  attached  to  the  hammer,  and  a  soft  striking  tip  was  used.  This  setup  provided 
the  necessary  excitation  force.  The  accelerometers,  located  at  the  points  mentioned  above 
measure  the  absolute  vibrational  response  of  the  structure  at  these  points.  Taking  the 
Fast  Fourier  Transform  (FFT)  of  the  accelerometers'  response  and  dividing  by  the  FFT 
of  the  input  (hammer),  a  transfer  function  is  made  at  each  accelerometer  location.  This 
is  done  automatically  with  GenRad.  To  reduce  noise  and  other  extraneous  influences,  an 
average  of  five  samples  was  taken. 

The  torsional  flexibilities  of  the  base  axis  are  pictorially  represented  in  Figure  2.21.  To 
simplify  the  system.  Figure  2.21  shows  a  linear  representation  of  an  actual  rotating  system. 
The  motor  output,  Xo  drives  the  inertial  mass  of  the  base,  ma,  through  a  combination  of 
a  spring  and  dashpot.  It  is  interesting  to  note  that  the  positional  feed-back  for  this  axis  is 
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taken  at  Xi,  or  off  a  pinion  gear  driven  by  the  crown  gear  of  the  base.  The  base  inertia, 
which  is  a  constant,  drives  through  a  second  spring  and  dashpot  combination,  a  second 
inertial  load  m;,.  The  variable  mass,  mf,  represents  the  upper  structure  of  the  robot  and  is 
dependent  on  the  configuration  of  the  manipulator  and  any  external  payload  the  robot  is 
carrying.  As  mentioned  previously,  the  inertial  load,  rrib  for  the  base  axis  may  change  in 
a  ratio  of  12:1  depending  on  the  robot  configuration  and  as  a  result,  affects  the  dynamic 
response  of  the  robot. 

The  linear  representation  of  the  base  axis  seen  in  Figure  2.21  includes  the  gear  ratio  of 
the  base  axis,  n,  represented  linearly  by  the  ratio  of  the  link  lengths  Ta/rb-  The  differential 
equations  for  the  spring/mass/dashpot  system  depicted  in  Figure  2.21  are  written  as 
follows: 

0     =     maxi  +  Ca(i-i  -  i'o)  +  cb{xi  -  i2)  +  K{xi  -  x'q)  +  kb{xi  -  X2)        (2.29) 
0     =     mbX2  +  Cb{i:2  -  xi) -V  h{x2  -  xi)  (2.30) 

The  variables  ig  and  x'q  in  the  above  equation  can  be  replaced  as  follows: 

0  =  mai'i  +  cJxi  -  -xq)  +  Cb[xi  -  ±2)  +  ka{xi  -  -xo)  +  hixi  -  X2)  (2.31) 

n  "■ 

where  xq  and  xo  are  the  motor  velocity  and  position,  respectively.  These  equations  are 
easily  implemented  into  a  simulation  program,  after  the  values  for  the  springs,  masses  and 
dashpots  are  obtained.  A  linear  representation  for  the  spring/mass  system  is  provided  in 
Figure  2.21.  It  should  be  noted  that  for  the  actual  base  axis,  the  positional  feedback  is 
taken  from  the  point  labeled  .1:1.  The  errors  caused  by  fca,  Ca  and  m^  can  be  eliminated 
over  time  because  they  are  contained  within  the  closed  positional  loop.  The  errors  caused 
by  the  second  spring/mass/dashpot  system  denoted  fc^,  m^,  and  Cfc  are  external  to  the 
positional  control  loop  and  are  not  eliminated  without  external  compensation. 

To  provide  values  for  m^,  rnj,,  c^,  Cft,  ka.  and  kb  several  transfer  functions  were  made. 
The  direct  transfer  function  taken  at  the  wrist  (point  1  in  Figure  2.20)  produced  two 
prominent  natural  frequencies  of  9.64  Hz  and  13.93  Hz.  The  six  transfer  functions  taken 
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at  the  points  described  above  indicated  that  for  the  lowest  frequency,  all  of  the  transfer 

functions  were  in  phase,  thus  describing  the  first  mode  of  vibration.  However,  the  phase 

for  the  second  mode  changed  between  the  transfer  functions  taken  at  point  (3)  and  (4), 

indicating  two  separate  masses,  one  located  at  the  base  and  the  other  at  some  point  above 

the  base.    Using  practical  experience  as  a  guide,  the  damping  ratios  for  those  natural 

frequencies  were  estimated  to  be  Ci  =  0.05  and  (2  =  0.08,  respectively.  By  measuring  the 

magnitude  of  the  imaginary  part  of  the  direct  transfer  function,  the  modal  spring  rates 

were  estimated  with  the  following  equation: 

/,.'.  _         i.'^^'^ni) /.2_3.2) 

'''  -  2Q\Im[G].^J 

where  ' 

Uni  -  the  I*'*  natural  frequency 

Q  -  the  i^^  damping  ratio 

ImfG'l-        -  the  magnitude  of  the  imaginary  part  of  the  i*''  natural  frequency 

The  modal  spring  constants  were  calculated  for  the  two  natural  frequencies  as  R'l   =  4.42  + 
10^  lb/in  (7.67  *  lO'^  N/m)  and  A'2   =   3.46  *  IQ-*  lb/in  (6.00  *  lO^N/m).  With  the  spring 
constants  known,  the  masses  can  be  calculated  using  the  following  equation: 

m,  =  -^  (2.33) 

The  masses  for  the  given  orientation  of  the  robot  equaled  1.21  and  4.52  Ih^sec^/m  (210  and 
784  N*5ec2/m)  respectively.  The  masses  and  stiffness  values  calculated  have  modal  coor- 
dinates and  need  to  be  transformed  to  local  coordinates  to  provide  useful  useful  modelinf 

information. 

Modal  coordinates  are  those  which  produce  diagonal  mass  [M],  stiffness  [K],  and  damp- 
ing [C]  matrices.  In  most  systems,  the  location  of  the  modal  coordinates  are  unknown,  so 
they  must  be  transformed  to  a  known  set  of  local  coordinates.  This  is  done  by  producing 
a  transformation  matrix  [P],  which  is  comprised  of  n  eigenvectors  representing  the  n  nodes 
of  vibration.  These  eigenvectors  are  the  nontrivial  solution  of  the  following  equation: 

[K]x^ul[M]x    i=l,2, ,n  (2.34) 
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and  correspond  to  each  mode  of  vibration.  Each  of  these  vectors  pi  has  a  unique  shape 
and  is  called  a  modal  vector  or  mode  shape.  Because  the  amplitude  of  the  mode  shape 
is  arbitrary,  it  is  customary  to  normalize  each  modal  vector  with  respect  to  a  specific 
reference  coordinate.  Assembling  the  n  normalized  modal  vectors  into  a  square  matrix, 
with  each  column  corresponding  to  a  single  mode  of  vibration,  results  in  the  formulation 
of  the  modal  matrix  [P]  [8]),  where 

[P]  =  bi,P2,...,Pn]  (2-35) 

Because  only  two  dominate  modes  of  vibration  were  recorded  at  the  wrist,  the  system 
was  modeled  as  a  two  degree-of-freedom  system.  The  transfer  functions  lead  to  an  initial 
conclusion  that  the  first  of  the  system's  two  masses  was  located  at  the  base,  and  the 
second  mass  was  located  at  the  wrist.  The  diagonal  modal  matrices,  [M]g  and  [K]q  are 
known;  however,  the  transformation  matrix,  [P]  is  needed.  The  matrix  [P]  can  be  directly 
produced  by  taking  the  ratio  of  the  respective  peaks  of  the  imaginary  parts  of  the  transfer 
function  at  the  appropriate  frequencies.  At  9.64  and  13.93  Hz,  the  amplitude  of  the 
imaginary  peaks  were  measured  for  both  the  direct  transfer  function  at  the  wrist  and  the 
cross  transfer  function  at  the  base  as  follows: 

Amplitude  Of  Imaginary  Peaks 
9.64  Hz     13.93  Hz 


DTP  at  Wrist        0.79  8.53 

CTF  at  Base  0.14  -1.55 


The  ratios  were  normalized  to  the  wrist  and  the  [P]  matrix  is  equal  to: 


[^^1  = 


0.0946     -0.089 
1  1 


(2.36) 


The  value  0.0946  is  equal  to  0.79  divided  by  8.53  and  similarly  -0.89  is  equal  to  0.14 
divided  by  -1.55.  Thus,  to  get  the  local  values,  standard  transformation  techniques  are 
used  to  transform  the  modal  mass  and  stiffness  matrices  into  local  coordinates  using  the 
following  equations  must: 

[Mh  =  [Pr^'iMUP]-'  (2.37) 
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and 


[A'jx  =  [p]-^mjp] 


-1 


so  [P]"^  and  [P]~'^  must  be  solved  for: 


and 


Solving  for  [K]x-,  the  result  is: 
1        "^ 


1 


0.1836 


1 


0.1836 


1       0.089 
-1     0.0946 


1  -1 

0.089    0.0946 


[Kh  = 


0.1836^ 


1  -1 

0.089    0.0946 


4.42       0 
0       34.6 


J    L 


or 


m.  - 


0.1836^ 


39.02     -2.88 
-2.88     0.345 


1       0.089 
-1    0.0946 


+  10' 


*10'' 


(2.38) 


(2.39) 


(2.40) 


(2.41) 


(2.42) 


But  this  does  not  correspond  correctly  to  the  local  spring  model  which  should  have 
the  following  form: 


[Alx  = 


li'a  +  Kb 

-Kb 


-Kb 
Kb 


(2.43) 


Therefore,  the  location  of  the  masses  must  be  different.    The  mass  mi  was  kept  on 

the  outer  radius  of  the  base,  and  the  location  of  the  second  mass,  m2  was  moved  from 

the  wrist.   In  changing  the  model,  it  is  important  that  the  the  transfer  function  at  the 

base  remains  constant  because  it  contains  the  two  modes  of  interest  and  their  respective 

damping  ratios.  The  stiffness  can  be  calculated  again  using  Equation  2.32.  The  pertinent 

information  for  the  first  two  modes  of  vibration  at  the  base  is  presented  below: 

ujni^  9.64Hz    Ci  =  0.05    fci  =  4.42*  lO^i^     rm  =  120.4^^ 
w„2  =  14.0ifs     (2  =  0.08     fc2  =  3.46*  10^1     m2  =  447.2^^ 

After  normalizing  the  transformation  matrix  to  the  base,  the  local  mass  and  stiffness 
matrix  can  be  re-written  as: 


and 


[M],  =  [PflAdUP] 


[K],  =  [Pf[KUP] 


(2.44) 


(2.45) 
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The  matrices  [P]  and  [P]^  are  defined  as  follows: 


[P]  = 


anc 


[PV  = 


1 

1 

p 

r 

1 

P 

1 

r 

(2.46) 


(2.47) 


Equations  2.44  and  2.45  are  the  inverse  of  Equations  2.37  and  2.38  respectively.  As- 
suming [M]:r  is  diagonal  (remember  that  [K]g  and  [M],  are  known  to  be  diagonal)  and 
[K]x  is  in  the  matrix  form  described  in  Equation  2.43,  Equations  2.44  and  2.45  can  be 
expanded  to  provide  the  following  six  equations: 

(2.48) 
(2.49) 
(2.50) 
(2.51) 
(2.52) 
(2.53) 

The  following  six  unknowns  are  produced:  m^,  rrib,  ka,  h,  p  and  r.  Using  the  last  three 
equations,  p  can  be  expressed  in  terms  of  mi,  m^  and  r,  resulting  in: 


0 

= 

prkb  -  {p  +  r)kt,  +  ka  +  kb 

ki 

= 

p^kb  -  2pkb  +  ka  +  kb 

k2 

= 

r'^kb-2rkb  +  ka  +  kb 

0 

= 

TTia  +  prrrib 

mi 

= 

TUa  +p'^mb 

7112 

= 

ma  +  r^rrib 

- — y 

1712 


(2.54) 


Taking  equation  2.49,  ka  can  be  solved  for  in  terms  of  p,  r  and  /c^: 


ka  =  kb{p+r  -pr  -  1) 


(2.55) 


Dividing  Equation  2.50  by  2.51  and  substituting  for  ka  in  the  resulting  equation,  an 
expression  for  r  in  terms  of  fci,  ^2,  m-i  and  m2  is  produced.  The  value  r  is  solved  for  as: 

ki  +  k2 


r  — 


ki  -  k2{mi/m2) 


=  -7.830 


(2.56) 
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and  then  the  value  of  p  can  be  found  with  the  following  equation: 

p--^r  =  2.130  (2.57) 

The  value  for  k^  can  be  solved  for  by  taking  Equation  2.50  and  substituting  for  ka  in  terms 

of  fci,  p  and  r: 

kk  =  -, ^ =  39,272-  =  6.81  *  10^-  (2.58) 

p^  +  r  —  p  —  pr  in  m 

and  now  solving  for  ka  using  Equation  2.55: 

ka  =  kb(p  +  r  -  pr  -  1)  -  391,810—  =  6.79  10^-  (2.59) 

ZTl  III 

Similarly,  rria  can  be  solved  for  in  terms  of  m;,,  p  and  r  using  Equation  2.52: 

rua  =  —p  *  r  *  mb  (2.60) 

Substituting  this  expression  into  Equation  2.53,  m;,  can  be  directly  solved  for: 

rrib  =  -^ =  5.727 : =  993.6 (2.61) 


^—  =  5.727— 
p^  —  p  *  r  in  m 


Knowing  m^,  771^  can  be  solved  for  using  Equation  2.60  and  the  result  is  m^  =  95.52/6  * 
sec'^/in  (1.66*  IC^iV  *5ec^/m).  Substituting  these  calculated  values  back  into  the  original 
six  equations,  an  error  check  was  successfully  made.  This  transformation  now  places  the 
first  local  mass,  nia  on  the  base  radius  and  the  first  local  spring,  ka  is  located  between 
the  servomotor  and  the  base.  In  a  similar  fashion,  the  second  local  spring,  kb  is  located 
between  the  ma  and  the  second  local  mass  mf,.  The  location  of  mb  is  not  exactly  known, 
but  it  should  be  obvious  that  it  is  located  somewhere  between  the  base  and  the  wrist  of 

the  robot. 

The  calculated  values  for  ka,  kb,  ma  and  mb  are  listed  in  the  table  below. 

ka  =  3.918  *  10^/6/m  6.97  *  WN/m 

kb  =  3.927  +  W^lb/in  6.99  *  lO^iV/m 

ma  =  95.52/6  *  sec'^/in  1.675  *  W^Kg 

mb  =  5.73/6  +  sec^jin  1.005  +  lO^A'^ 

The  ratios  between  the  stiffness  of  the  base  transmission  {ka)  and  tlie  arm  {kb)  is  approx- 
imately 10:1.    This  appears  to  be  reasonable  when  comparing  the  appropriate  transfer 
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Figure  2.22:  Positional  Block  Diagram  Including  Flexibilities 

functions.  However,  all  the  calculated  stiffness  and  mass  values  appear  to  be  too  large 
when  compared  to  the  values  found  by  Stern  and  Tlusty  [15].  The  mass  of  the  base  has 
the  highest  correspondence  between  the  two  measurement  experiments,  so  this  value  was 
used  to  scale  the  measurements  made  by  this  author.  The  mass  of  the  base,  mt,  is  approxi- 
mately seven  times  larger  than  the  corresponding  mass  found  by  Stern.  Thus  scaling  down 
the  masses  and  the  stiffness  values  to  one  seventh  of  their  original  values,  the  resulting 
stiffness  of  the  arm  is  approximately  equal  to  5600  lb/inch,  (which  is  approximately  equal 
to  the  static  deflection  of  the  T3-776  robot  found  by  Sklar  [9]).  This  value  is  much  more 
reasonable  when  compared  to  the  original  value  of  39,200  lb/inch.    The  primed  values 

listed  in  the  table  below  are  the  corrected  values. 

k'^  =  5.597  +  lOHb/in  9.957  *  lO^N/m 

k'^  =  5.610  *  lO^lb/in  9.987  *  lO^N/m 

m^  =  13.64/5  *  sec'^/in  2.385  *  10^ A'^ 

m't  =  0.818/6  +  secy  in  1.430  *  IQ'^Kg 

With  values  for  local  masses  and  stiffness  values  available,  the  simulation  program  for 

the  base  axis  was  expanded  to  include  ka  and  rUa  in  the  positional  control  loop  and  kb  and 

rrib  outside  of  the  positional  control  loop.  Figure  2.22  provides  a  simplified  block  diagram 

of  the  positional  control  loop  including  the  measured  flexibilities.  Again,  it  is  difficult  to 

verify  this  simulation,  because  no  accurate,  real  time,  displacement  measurement  device 

with  the  required  range  and  resolution  was  available.    However,  the  acceleration  of  the 

masses  ma  and  mj,  could  have  been  recorded  real  time  and  compared  to  the  accelerations 

of  those  masses  obtained  in  the  simulation.   The  location  of  ma  is  accurately  known  so 

the  acceleration  of  that  point  could  be  accurately  monitored.  Because  the  location  of  rub 
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is  not  exactly  known,  the  acceleration  of  that  point  would  not  be  accurately  measured. 

The  value  rua  corresponds  to  the  time  invariant  inertial  term  that  does  not  effect  the 
dynamic  response  of  the  base  axis.  However,  the  m^  represents  the  time  varying  term  that 
does  effect  the  dynamic  response  of  the  base  axis.  The  next  section  will  present  several 
compensation  schemes  that  would  compensate  for  the  time  varying  inertia  described  above. 

Several  Dynamic  Compensation  Schemes 

To  compensate  for  the  non-linearities  due  to  the  ever  changing  configurations  and  loads, 
and  for  the  dynamic  coupling  between  the  joint  motions,  several  compensation  methods 
have  been  devised  by  various  researchers.  They  include  feedforward  compensation  schemes 
with  both  on  and  off-line  calculations  of  the  torque  equation  coefficients,  adaptive  control 
utilizing  state  variable  feed  back  and  finally  direct  torque  compensation  schemes.  Some  of 
these  methods  allow  any  desired  behavior  of  the  end  effector  by  choosing  the  appropriate 
coefficients  for  the  controlling  equations. 

Figure  2.23  illustrates  feedforward  compensation  of  a  simple  position  controlled  servo- 
motor. The  variable  qo  is  the  desired  input,  qj.  is  the  actual  velocity  output,  and  q  is  the 
actual  position  output.  The  various  parameters  which  influence  the  dynamic  behavior  of 

the  system  are  listed  below: 

1.  Ci  -  gravity  influence  coefficients 

2.  Tst  -  Coloumb  friction  coefficients 

Z.  Fyj  -  viscous  damping  influence  coefficients 

4.  Kv  -  rate  feedback  damping  coefficients 

5.  An  -  time  varying  inertial  loads 

The  influence  of  gravity  and  coloumb  friction  affects  the  steady  state  behavior  of  the 
system.  Viscous  damping  and  rate  feedback  damping  affects  the  tracking  error  of  the 
robot,  and  the  influence  of  the  time  varying  inertia  affects  the  the  dynamic  behavior  of 
the  robot.  Each  of  these  influences  can  be  separately  modeled  and  compensated  for  in  a 
straightforward  manner.  However,  in  many  cases,  it  may  be  difficult  to  accurately  predict 
particular  influence  coefficients  in  real  time. 
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Figure  2.23:  Feedforward  Compensation  for  Parameters  Variation 
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Since  it  is  difficult  to  calculate  the  position  dependent  parameters  for  the  torque  in 
Equation  2.1  in  real  time,  they  might  be  calculated  in  advance,  tabulated  and  stored  for  all 
possible  configurations.  This  strategy  was  impractical  at  that  time  (1978)  because  of  the 
huge  amount  of  data  required  to  be  calculated  and  stored.  In  1978,  Raibert  [16]  suggested 
that  the  work  volume  of  the  robot  be  divided  into  discrete  zones,  where  the  required 
coefficients  would  be  calculated,  stored  and  assumed  constant  for  a  particular  zone.  These 
coefficients  could  then  be  used  to  provide  the  appropriate  servo  gains  for  each  zone.  This 
methodology  was  later  improved  by  smoothing  the  coefficients  between  adjacent  zones 
with  curve  fitting  routines,  so  the  transition  between  zones  was  not  apparent.  But  this 
method  is  only  possible  when  the  task  is  completely  known,  including  both  the  robot's 
path  and  any  additional  loads  applied  to  the  robot  [16]. 

This  above  task  could  be  further  simplified  by  partitioning  the  motions  of  the  robot 
into  two  or  more  groups.  For  example,  the  motions  of  a  typical  articulated  six  degree- 
of- freedom  robot  could  be  divided  into  two  groups,  those  of  the  structure  (the  first  three 
degrees-of- freedom)  and  those  of  the  wrist.  If  the  work  volume  of  the  robot  were  parti- 
tioned into  n^  nodes  related  to  the  position  of  the  wrist,  and  the  orientation  of  the  wrist 
was  divided  into  n^  nodes  also,  a  total  of  2  x  n'^  nodes  would  have  to  be  calculated.  On 
the  other  hand,  if  the  equations  were  not  partitioned,  then  a  total  of  n^  nodes  would 
be  required  for  the  same  resolution.  Thus,  partitioning  the  dynamic  equations  of  motion 
greatly  reduces  the  required  memory  of  the  computer,  in  this  case  by  n^ /2,  for  the  six 
degree-of- freedom  robot. 

Luh,  Walker  and  Paul  [17]  developed  an  elegant  recursive  algorithm  to  calculate  the 
required  joint  torques,  using  Newton-Euler  dynamic  equations.  First,  the  velocities  and 
accelerations  are  computed  recursively  from  the  base  to  the  tip  of  the  robot,  that  is,  the 
velocity  and  acceleration  of  each  link  is  based  in  part  on  the  velocity  and  acceleration  of 
the  previous  link.  Then  the  required  joint  forces  (for  prismatic  joints)  and  torques  (for 
revolute  joints)  are  produced,  again  recursively,  but  now  starting  with  the  last  link  (the 
link  furthest  from  the  base)  and  ending  with  the  base  link. 
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This  algorithm  is  one  of  the  fastest  existing  algorithms  for  dynamic  computation.  The 
number  of  multiplications  required  to  solve  this  recursive  equation  is  852  for  a  general 
six  degree-of-freedom  manipulator.  It  takes  approximately  4.5  milliseconds  on  average  to 
compute  the  six  joint  torques  on  a  PDP  11/45  minicomputer  using  floating  point  assembly 
language  [18]. 

Another  approach  to  provide  the  torque  information  involves  the  simplification  of  the 
the  torque  equation  based  upon  an  analysis  of  the  terms.  The  most  common  initial 
proposal  is  the  elimination  of  the  coefficient  matrix  for  the  centripetal  and  the  Coriolis 
forces  with  the  assumption  that  these  terms  are  not  significant  except  at  high  speeds 
[19],  [20].  Specifically  for  the  Stanford  Arm,  Paul  [20]  states  that  the  actuator  inertias 
completely  dominate  the  velocity  interaction  terms.  For  different  high  speed  robots,  these 
terms  which  were  previously  eliminated  may  become  significant. 

Paul  [21]  introduced  another  simplification  scheme  where  the  coupled  inertia  matrix 
[Aij],  was  eliminated  leaving  just  the  diagonal  effective  inertia  matrix  [Ai]  for  joint  i  active. 
Improving  this  technique,  Paul  [20]  introduces  an  inertia  matrix  with  just  limited  cross 
coupling  terms. 

Note  that  for  these  and  other  potentially  good  dynamic  computation  methods,  the 
constants  required  to  produce  the  various  coefficients  (for  example,  the  link  mass,  length 
and  location  of  the  center  of  mass)  must  be  accurately  known.  In  many  instances,  the 
manufacturer  of  particular  manipulators  are  unable  to  provide  these  values.  One  method 
of  obtaining  the  necessary  parameters  would  require  that  the  robot  be  disassembled  to 
obtain  the  needed  values.  In  fact,  this  is  precisely  what  occurred  at  Stanford.  A  PUMA 
560  arm  was  disassembled  and  measurements  were  made  to  determine  the  mass,  mass 
centroid  and  rotational  inertia  of  the  links  [12]. 

A  new  method  has  been  developed  by  Atkeson  [11],  where  the  inertial  parameters  of 
manipulator  rigid  body  loads  and  links  are  automatically  estimated  as  a  result  of  general 
robot  motions.  This  method  involves  reformulating  the  Newton-Euler  equations  of  mo- 
tion as  they  linearly  relate  the  measured  forces  and  torques  via  acceleration  dependent 
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coefficients  to  tlie  inertial  parameters.  Load  estimation  was  implemented  on  two  robots, 
a  PUMA  600  robot  and  the  MIT  Serial  Link  Direct  Drive  Arm.  Good  estimates  were 
obtained  for  the  load  mass  and  center  of  mass  and  the  forces  and  torques  due  to  these 
loads  could  be  accurately  predicted.  A  good  match  was  made  between  joint  torques  from 
the  estimated  joint  parameters  and  the  joint  torques  observed  from  the  measured  motor 
currents.  However,  limitations  of  the  link  inertia  parameters  due  to  restricted  sensing  and 
motion  of  some  links  have  reduced  the  quality  of  the  measurements. 

A  significant  limitation  of  these  dynamic  measurements  is  that  the  effects  of  friction 
are  not  taken  into  account.  In  many  instances,  the  friction  may  constitute  a  large  part  of 
the  required  joint  torque,  greater  than  some  of  the  other  parameters  which  are  typically 
modeled.  If  this  is  not  included  in  the  torque  equation,  the  calculated  torque  may  be 
in-accurate  and  cause  errors  in  the  desired  motion  of  the  manipulator. 

Adaptive  control  schemes  provide  another  method  of  dynamic  compensation  to  the 
controller.  The  adaptive  control  approach  has  the  major  advantage  of  not  needing  an 
accurate  dynamic  model  of  the  system  it  controls.  Each  axis  would  be  represented  by  a 
decoupled,  low  order  dynamic  model  with  constant  parameters.  An  adaptive  mechanism 
would  vary  the  control  parameters  on-line  in  response  to  system  parameter  changes  (either 
measured  directly  or  estimated  iteratively  on-line)  and  cross  influences  from  other  links. 
The  adaptive  mechanism  can  be  based  upon  an  implicit  system  identification,  where  the 
control  parameters  are  calculated  using  traditional  control  system  design  rules.  The  con- 
trol variable  (the  input  torque)  is  then  computed  for  the  minimum  average  deviation  of 
the  joint  trajectories  from  the  nominal  joint  trajectories. 

The  overall  system  behavior  can  be  specified  using  a  reference  model  or  by  creating 
an  adaptive  model  of  the  system.  Figure  2.24  shows  the  overall  process  for  the  control  of 
a  single  joint  using  an  adaptive  control  scheme.  Subjected  to  the  same  input  as  the  real 
system,  the  model  yields  the  desired  behavior  at  its  output.  The  computational  burden 
for  the  calculation  of  the  control  parameters  and  for  the  eventual  model  identification  is 
considerable,  as  they  must  be  performed  on-line  during  one  sampling  period.   Although 
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Figure  2.24:  Adaptive  Control  Model  of  Robot  Controller  (Adapted  from  [10]) 

the  computation  of  either  Lagrangian  or  Newton- Euler  equations  is  completely  avoided, 
the  iterative  computation  time  is  still  too  long  for  on-line  operation. 

It  is  evident  that  dynamic  compensation  is  needed  for  some  robot  controllers  where 
high  speed  and  high  accuracy  motions  are  required.  In  1980,  Wu  and  Paul  [22]  com- 
pleted an  experiment  on  a  single  degree-of-freedom  manipulator  with  an  internal  joint 
sensor.  A  completely  linear  model  of  the  system  was  adopted  and  used  to  develop  an  ana- 
log compensation  method  which  incorporated  a  torque  sensor  at  the  joint.  Because  the 
feedback  loop  was  closed  around  the  joint  and  all  the  hardware  was  analog,  the  scheme 
avoided  computational  difficulties,  required  no  differential  approximation  and  provided 
fast  response. 

Similar  analog  compensation  schemes  have  been  implemented  on  other  robotic  test 
beds.  The  first  two  joints  of  the  Stanford  manipulator  have  been  redesigned  and  fabri- 
cated to  include  force  sensors  and  the  associated  electronics  required  to  eliminate  external 
dynamic  effects.  For  example,  an  average  of  1072  oz-in  (7.56  Nm).  was  required  to  over- 
come pure  mechanical  friction  when  the  third  joint  was  rotated.  After  activating  the 
direct  torque  compensation  scheme,  the  amount  of  force  required  for  the  same  task  was 
reduced  to  33.5  oz-in  (0.24  Nm).  The  results  of  the  experiments  performed  on  the  modified 
manipulator  are  detailed  in  Maples  [23]. 
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Van  Brussel,  1985  incorporated  a  similar  compensation  technique  on  a  two  degree-of- 
freedom  planar  manipulator.  Strain  gauge  torque  meters  were  installed  on  tlie  joint  shafts 
with  the  measured  torque  sent  to  a  digital  controller  instead  of  an  analog  system.  Similar 
improvements  in  the  dynamic  response  were  observed  during  tests  of  this  manipulator 
[10]. 

The  compensation  schemes  incorporating  torque  measuring  devices  will  be  defined  as 
direct  compensation  schemes,  where  the  external  load  torques  are  measured  rather  than 
estimated  or  observed.  Three  major  advantages  are  realized  when  using  the  direct  dynamic 
compensation:  accurate  dynamic  models  of  the  systems  to  be  controlled  are  not  required, 
no  dedicated  high  speed  computer  is  required,  and  the  direct  method  includes  frictional 
effects  which  were  not  modeled  in  the  other  compensation  schemes. 

The  main  disadvantage  to  direct  dynamic  compensation  is  that  external  load  torques 
are  measured  with  strain  gauge  torque  meters.  For  many  applications  on  existing  ma- 
nipulators, it  would  be  difficult  to  place  a  strain  gauge  on  a  joint  without  making  major 
modifications  to  the  robot.  A  new  method  was  devised  where  the  load  torque  of  a  par- 
ticular joint  can  be  accurately  observed  rather  than  being  directly  measured  with  strain 
gauges. 

The  observed  compensation  scheme  requires  that  various  parameters  of  the  control 
system  be  continuously  monitored,  including  the  motor  current  and  tachometer  output. 
With  these  values,  the  load  torque  can  be  accurately  estimated  and  used  as  the  input 
to  the  direct  compensation  scheme  mentioned  previously.  Both  the  direct  and  observed 
compensation  scheme  will  be  discussed  in  detail  later  in  the  next  section. 

Direct  and  Observed  Dynamic  Compensation  Schemes 

This  section  will  discuss  the  development  and  implementation  of  both  the  direct  and 
observed  compensation  schemes.  The  direct  compensation  method  requires  that  the  ex- 
ternal load  torques  be  measured  directly  with  a  torque  sensor  and  then  be  used  in  the 
compensator.  The  observed  compensation  scheme  uses  an  estimator  to  provide  load  torque 
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information  to  the  compensator.  To  simplify  the  description  of  the  operation  of  tlie  com- 
pensator, some  generalizations  will  be  made  as  related  to  the  operation  of  the  amplifier. 
This  will  become  evident  as  the  compensation  scheme  is  explained. 

The  mechanism  for  direct  dynamic  compensation  will  now  be  developed.  A  direct 
compensation  technique  was  produced  that  theoretically  could  completely  eliminate  the 
effects  of  external,  time  varying  loads.  The  main  idea  behind  this  method  consists  of 
considering  the  time  varying  load  torque  acting  directly  upon  a  particular  joint  drive 
as  a  disturbance  torque  (uncontrollable  input),  to  the  controlled  axis  drive,  where  the 
parameters  of  the  drive  are  considered  to  be  time  (position)  invariant.  Thus,  only  the 
constant  loads  (motor  and  reduction  gear  inertias  and  frictions)  are  considered  to  belong 
to  the  controlled  system. 

Equation  2.1  can  be  rewritten  as: 

T,  =  [A,,]q,  +  {[A,j\q,  +  [B,,]q-q,  +  [Ci,k]q(qj  +  Di  +  Ei  +  F{]  (2.62) 

where 

Ti  -  the  drive  torque  vector  at  joint  i 

qi  -  the  position  of  joint  i 

[An]  -  the  fbced  inertia  matrix  for  joint  i 

[Aij]  -  the  coupled  inertia  matrix  between  joint  i  and  j 

[Bij]  -  the  coefficient  matrix  of  the  centripetal  forces 

[Cijk]  -  the  coefficient  matrix  of  the  Coriolis  forces 

Di  -  the  vector  of  gravitational  forces 

Ei  -  the  vector  of  externally  applied  forces  at  the  end  effector  transformed  to  the  individual 
joints. 

Fi  -  the  vector  of  frictional  load  torques 

The  terms  in  the  brackets  are  defined  as  the  time  varying  load  torques,  T^.  Note  that 
the  loads  due  to  friction  are  also  included  in  this  equation.  These  external  torques  can 
be  measured  directly,  with  strain  gauge  torque  meters  incorporated  in  the  drive  system. 
The  time  invariant  term,  [Ajjjg,-,  is  due  to  the  fixed  inertia  of  a  particular  joint  being 
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Figure  2.25:  Block  Diagram  of  Direct  Compensation  Scheme 

accelerated  and  will  be  referred  to  as  Tmi-  In  this  case,  only  the  inertia  of  the  motor  is 
included  in  the  term  Tmi,  all  other  loads  will  be  included  in  the  time  varying  load,  T/,-. 
Equation  2.62  can  now  be  rewritten  as: 


-'-i  —  -I-  li  'T  -L  mi 


(2.63) 


The  above  torque  equation  is  now  rewritten  so  that  the  load  torque,  T;,-,  is  determined 
by  taking  the  difference  between  the  total  torque  produced  by  the  servomotor,  T,,  and  the 
motor  torque,  Tmi- 

Tii  -  T,  -  Tmi  (2.64) 

This  measured  load  torque  is  then  sent  to  a  direct  dynamic  compensator  circuit  then, 
ideally  these  time  varying  load  effects  will  be  exactly  eliminated  in  real  time.  Experiments 
on  VanBrussel's  [10]  two  arm  setup  showed  that  direct  compensation  is  feasible  and  easily 
implemented  on  a  dedicated  digital  microprocessor.  The  method  provides  a  valuable 
alternative  for  the  computational  intensive  analytical  methods  discussed  earlier. 

A  simplified  block  diagram  of  the  direct  compensation  scheme  is  presented  in  Fig- 
ure 2.25.  The  non-linear  gains  of  the  PID  amplifier  and  the  SCR  thyristor  circuit  have 
been  represented  as  Kpw  and  KscR  respectively. 

The  need  of  accurately  modeling  the  various  parameters  will  now  be  made  evident. 
The  numerator  of  the  closed-loop  transfer  function,  depicted  in  Figure  2.25  can  be  written 
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as: 

KpRpioKscnKt  ^-^    ,  KpwKscRKtjj      ^  /r,  ^-\ 
uTR ^^+        LS^R       ^'-^'                           ^^-^'^ 

The  compensation  voltage,  U;  is  used  to  eliminate  the  effects  of  the  load  torque,  T/. 
The  proper  gain  of  the  compensator,  Gci  can  be  found  by  setting  the  last  two  terms  of 
Equation  2.67  equal  to  each  other  and  solving  for  17; . 

G.  =  fracU.Tl  =  j/"^/  .,,  (2.66) 

The  variables  in  the  above  equation  are  primed  because  they  represent  the  modeled  values 
of  their  unprimed  counterparts.  Additionally,  the  measured  or  modeled  load  torque  is 
denoted  by  a  primed  variable  also.  Substituting  Equation  2.70  into  Equation  2.67,  the 
numerator  for  the  direct  compensated  control  loop  can  be  written  as: 

KpKpipKsCRKt  y       KpipKscRKt       L's  +  R'      rp,     rp  o  n\ 

Ls  +  R  '"^        LS  +  R       K'scnK'pwI^i 

Assuming  that  the  primed  variables  are  equal  to  their  unprimed  counterparts,  the  effects 

of  all  external  load  torques  can  be  exactly  eliminated  in  real  time. 

One  disadvantage  seen  with  these  direct  dynamic  compensation  schemes  is  that  high 
resolution  torque  sensors  or  strain  gauges  must  be  placed  at  each  joint  axis.  In  many 
instances,  this  would  require  extensive  modifications  of  existing  hardware  to  provide  an 
adequate  location  for  the  torque  sensor.  To  circumvent  this  problem  of  hardware  modifi- 
cation, a  method  to  observe  the  load  torque  was  developed  which  provided  the  required 
measured  load  torque  to  the  compensation  circuit.  This  method  of  compensation  has  been 
defined  as  an  observed  compensation  scheme. 

Instead  of  measuring  the  load  torque  directly,  the  observed  compensation  scheme  uses 
fixed  motor  parameters  and  measured  variables  to  produce  an  accurate  representation  of 
the  external  load  torque.  The  observed  load  torque,  T/^  is  then  used  in  the  same  manner 
as  the  previously  mentioned  measured  load  torque.  The  methodology  behind  the  observer 
will  now  be  explained.  Equation  2.64  can  be  rewritten  for  a  single  joint  as: 

Ti  =  Tt-  Tm  (2.68) 
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For  DC  servomotors,  there  is  a  proportional  relationship  between  the  current  applied  to 
the  motor,  I,  and  the  total  torque  output  of  the  motor,  Tt.  Similarly,  there  is  a  proportional 
relationship  between  the  armature  acceleration  and  the  torque  required  to  accelerate  the 
motor.  Therefore,  the  load  torque,  T/  can  be  found  by  monitoring  both  the  motor  current 
and  the  rotational  acceleration  of  the  motor's  armature.  The  relationships  can  be  found 
in  the  following  equation: 

Ti  =  Tt-T^  =  Kt*I-J^  (2.69) 

where 

T;  -  the  load  torque  on  the  motor 

Tt  -  The  total  torque  produced  by  the  motor 

T-m  -  the  torque  required  to  accelerate  the  armature  inertia 

li't  -  the  torque  constant  of  the  motor 

/  -  the  current  applied  to  the  motor 

J  -  the  inertia  of  the  motor  armature 

^  -  the  time  derivative  of  the  armature  velocity 

With  this  simple  equation,  the  load  torque,  due  to  all  external  sources  listed  previously, 
can  be  accurately  observed.  The  current  can  be  directly  measured  using  a  bus-bar  current 
monitoring  device.  Because  the  acceleration  of  the  armature  can  not  be  directly  monitored, 
the  derivative  of  the  motor  velocity  is  used  instead.  The  motor  velocity  is  conveniently 
obtained  with  the  motor  tachometer. 

The  load  torque  observer  is  represented  as  a  block  diagram  in  Figure  2.26.  Again,  it  is 
important  that  the  primed  variables,  Kj  and  J!^  be  accurately  known  so  the  load  torque 
can  be  correctly  observed.  If  the  motor  acceleration,  u;^  could  be  directly  measured, 
the  differentiator  (denoted  by  the  s  term)  in  the  observer  could  be  eliminated,  further 
simplifying  the  circuit.  As  mentioned  before,  the  observed  load  torque,  T/^  would  be  sent 
to  the  same  compensation  circuit  used  for  the  measured  torque  compensation  scheme 
described  earlier. 
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Figure  2.26:  Load  Torque  Observer 


A  simulation  of  the  observed  compensation  scheme  was  implemented  on  a  simplified 
model  of  the  servo  controller.  For  example,  the  PID  amplifier  and  the  SCR  thyristor 
circuit  were  represented  as  constant  gains.  These  simplifications  were  made  to  provide 
a  simulation  of  the  effects  of  dynamic  compensation  on  an  approximate  model  of  the 
base  servo  system.  The  values  for  the  other  variables  were  obtained  from  the  previous 
simulations  of  the  base  servo  system. 

Step  inputs  in  load  torque  were  applied  to  the  simulated  system  and  both  the  compen- 
sated and  uncompensated  results  are  presented  in  Figure  2.27.  The  loads  applied  to  the 
system  were  quite  large,  equivalent  to  a  200  pound  horizontal  load  applied  to  the  wrist  of 
the  robot  in  an  extended  configuration.  This  corresponds  to  approximately  20,000  inch 
lb  (2280  N  m)  of  torque  applied  to  the  crown  gear  of  the  robot.  Without  compensa- 
tion, deflections  of  +/-  3  *1G~'*  radians  were  produced  in  the  simulation.  It  should  be 
noted  that  this  simulation  exercise  did  not  include  flexibilities  of  the  structure  or  drive- 
train.  The  uncompensated  deilections  correspond  to  displacements  of  approximately  +/- 
0.030  inch  (0.76  mm)  at  the  wrist  with  the  robot  in  an  extended  configuration.  With  the 
compensation  active,  the  deflections  were  reduced  to  negligible  amounts. 

With  the  encouraging  results  from  the  simulation  exercise,  the  compensation  method 
was  then  implemented  on  the  base  servo  system.   The  implementation  methodology  and 
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Figure  2.27:  Dynamic  Response  of  Compensated  System  to  Step  Inputs  in  Load  Torque 

results  will  be  presented  in  the  following  section. 

Implementation  Strategy  and  Results  of  an  Observed  Compensation  Scheme 

The  observed  torque  compensator  is  comprised  of  the  load  torque  observer  and  the 
compensator  gain.  The  design  of  the  torque  observer  shall  first  be  described.  The  motor 
current,  /  was  measured  using  a  standard  bus-bar  with  a  calibrated  output  of  37  mv/A. 
The  schematic  diagram  for  the  load  torque  observer  and  compensation  circuit  is  shown 
in  Figure  2.28.  Because  the  voltage  proportional  to  the  current,  Vi,  is  a  floating  voltage, 
a  floating  source  amplifier  was  built  and  the  output  was  directed  to  an  adjustable  gain 
inverting  amplifier.  The  output  from  this  amplifier,  U  was  then  sent  to  an  inverting 
summing  amplifier.  The  voltage  proportional  to  the  motor  velocity,  V^  is  the  input  for 
a  low  noise  differentiator  and  the  output  from  the  differentiator,  V^j  is  sent  to  the  same 
adjustable  gain  summing  amplifier  as  U.  This  summing  amplifier  incorporates  a  circuit  to 
eliminate  DC  bias  voltages.  The  output  of  this  summing  amplifier  is  the  observed  load 
torque,  T/^. 

Next  the  design  of  the  actual  dynamic  compensator  will  be  presented.  For  this  com- 
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Figure  2.28:  A  Simplified  Schematic  of  tlie  Compensation  Circuit 
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pensator  design,  the  non-linearities  of  the  PID  controller  were  ignored  to  simplify  the 
compensation  circuit.  Both  the  PID  amplifier  and  the  SCR  circuit  were  modeled  as  linear 
gain  amplifiers.  In  addition,  the  inductance  of  the  motor  was  not  included  in  the  com- 
pensation circuit  because  the  electrical  time  constant  Tg  (0.0056  second)  is  approximately 
equal  to  only  20  percent  of  the  mechanical  time  constant  r^  (0.027  second).  This  elim- 
inated an  additional  differentiator  and  summing  amplifier  in  the  compensation  circuit. 
Thus  the  gain  of  the  compensator,Gc  is  equal  to: 

Gc  =  g  (2.70) 

A  linear  amplifier  with  the  appropriate  gain  was  built,  it  also  incorporated  a  low  pass  filter 
to  attenuate  high  frequency  noise.  The  output  of  this  linear  amplifier  is  the  compensation 
voltage,  Ui  and  is  introduced  to  the  input  summing  amplifier  of  the  servomotor  controller. 

Several  tests  were  devised  to  determine  the  effectiveness  of  dynamic  compensation.  The 
uncompensated  closed  velocity  loop,  open  positional  loop  response  of  the  servomotor  was 
used  as  the  baseline.  The  closed  loop  velocity  response  of  the  servo  system  was  performed 
by  removing  the  timing  belt  from  the  motor  pulley,  thus  eliminating  positional  feedback 
from  the  system  (the  resolver  for  the  first  three  axes  of  the  robot  are  located  at  the  joint 
and  not  at  the  motor).  Various  outputs  from  a  signal  generator  were  introduced  to  the 
input  summing  node  of  the  PID  controller.  First,  step  inputs,  in  the  form  of  square  waves, 
were  commanded  and  the  tachometer  output  was  recorded.  With  the  small  inertial  load 
of  the  motor,  including  the  armature,  tachometer  and  pulley,  small  over-shoots  occurred 
with  a  settling  time  of  0.09  seconds. 

Next,  the  inertial  mass  of  the  motor  was  doubled  by  rigidly  attaching  a  disk  to  the 
motor  pulley,  increasing  the  inertia  to  0.175  inch  lb  5ec^/rad  (0.02  N  m  5ec^/rad).  Fig- 
ure 2.29  represents  the  time  record  of  the  tachometer  output  for  the  servo  system  with 
square  wave  inputs.  The  uncompensated  signal  shows  the  settling  time  to  be  approxi- 
mately 0.16  sec,  and  with  the  compensation  active,  the  settling  time  is  decreased  to  0.10 
sec.  A  second  disk  was  rigidly  attached  to  the  motor  raising  the  external  inertial  load  to 
0.35  inch  lb  5ec^/rad  (Q.04N  m  sec^/rad).  Figure  2.30  reveals  the  settling  time  of  the  base 
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Figure  2.31:  Original  and  Alternate  Feedback  Paths  For  Dynamic  Compensation 

servo  to  a  step  input  in  velocity.  For  the  uncompensated  case,  the  settling  time  was  equal 
to  0.25  seconds  and  with  the  compensation  active,  the  settling  time  was  reduced  to  0.15 
seconds. 

Another  test  was  performed,  where  an  impulse  was  commanded  at  the  input  and  the 
response  of  the  system  with  the  medium  inertial  load,  0.175  inch  lb  5ec^/rad  (0.02  N 
m  5ec-^/rad)  was  evaluated.  The  settling  time  was  again  reduced  by  approjcimately  40 
percent  when  the  compensator  was  active.  These  tests  point  to  the  conclusion  that  the 
compensation  method  introduced  here  does  improve  the  dynamic  response  of  a  velocity 
servo  loop.  The  improvement  is  seen  without  having  a  perfect  model  of  the  servo  controller 
incorporated  in  the  compensator  circuit.  Perhaps  a  better  compensation  could  be  provided 
if  a  more  accurate  model  was  used. 

Because  the  compensation  feedback  signal  was  introduced  at  the  input  node  of  the 
PID  amplifier,  models  of  both  the  PID  amplifier  and  the  SCR  circuitry  had  to  be  included 
in  the  compensation  gain  Gc-  By  introducing  the  compensation  signal  to  the  input  of  the 
SCR  circuit  rather  than  the  PID  amplifier,  an  accurate  model  of  the  PID  amplifier  would 
no  longer  be  required.  The  block  diagram  in  Figure  2.31  illustrates  the  both  the  original 
and  the  alternate  compensation  feedback  placement  in  the  servo  driver.  The  numerator 
for  the  transfer  function  using  this  alternate  method  is  found  in  the  following  equation: 


K-pKpwKscRKt  ^r    ,   li'scRKt  L's  +  R' 


(2.71) 


Ls^R  "  '    LS  +  R  K'scRl^'t ' 

As  in  Equation  2.67,  the  load  torque  in  Equation  2.71  is  ideally  eliminated  when 
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accurate  models  of  the  SCR  thyristor  circuit  and  the  servomotor  are  used.  The  alternate 
method  was  simulated  and  the  results  were  again  excellent.  In  the  actual  SCR  thyristor 
circuit,  a  summing  junction  is  found  at  the  input,  allowing  a  quick  installation  of  this 
compensation  scheme. 

Through  simulation  it  is  evident  that  dynamic  compensation  can  improve  the  dynamic 
performance  of  servo  mechanisms.  However,  the  improvements  on  systems  with  high  gear 
reductions,  the  base  axis  of  the  T3-776  for  example,  are  virtually  impossible  to  measure. 
For  systems  with  small  gear  reductions  or  direct  drive  systems,  dynamic  compensation  in 
one  form  or  another  is  required  for  adequate  dynamic  performance.  Both  the  direct  and 
observed  dynamic  compensation  methods  are  excellent  dynamic  compensation  techniques. 
New  robot  designs  could  include  the  means  of  providing  joint  torque  measurement  schemes 
(strain  gauges  for  example)  so  that  direct  dynamic  compensation  could  be  provided.  Exist- 
ing robots  could  be  retrofitted  with  the  observed  dynamic  compensation  technique  without 
making  modifications  to  the  existing  robot  structure. 

Both  the  direct  and  observed  compensation  schemes  would  require  accurate  models 
of  the  SCR  thyristor  circuitry,  and  these  models  could  be  applied  in  either  analog  or 
microprocessor  based  digital  compensation  circuits.  At  this  time,  a  simple  linear  model 
of  the  SCR  circuit  could  be  easily  designed  and  built  using  analog  circuits.  But  a  more 
accurate  model  of  the  SCR,  providing  improved  compensation,  could  be  implemented 
much  faster  and  efficiently  in  a  digital  circuit.  These  methods  would  provide  real  time 
dynamic  compensation  without  needing  an  accurate  dynamic  model  of  the  robot  structure 
and  dedicated,  high  cost,  real  time  computer  equipment  needed  for  the  other  compensation 
schemes  described  earlier. 

As  mentioned  above,  models  of  the  servo  system  are  required  for  the  dynamic  compen- 
sation schemes.  The  transfer  function  for  the  permanent  magnet  motors  and  their  SCR 
thyristor  circuits  would  be  similar  from  robot  to  robot.  A  general  model  for  the  motor  and 
driver  could  be  produced  and  measuring  techniques  could  be  developed  to  customize  the 
general  model  for  each  particular  application.    Additionally,  some  manufacturers  supply 


68 

the  needed  transfer  functions  and  motor  parameters,  reducing  the  modeling  time  further. 
In  comparison,  the  time  required  to  produce  an  accurate  dynamic  model  of  a  particular 
robot  is  great,  in  many  cases  the  robot  would  have  to  be  disassembled,  carefully  measured 
and  then  re-assembled.  And  even  then,  the  effects  of  the  drivetrain  friction  would  not 
be  taken  into  account.  As  the  need  to  improve  the  dynamic  performance  of  industrial 
robots  becomes  more  critical  due  to  more  difficult  applications,  robot  manufacturers  may 
themselves  supply  the  needed  compensation,  or  provide  the  necessary  models  of  the  motor 
drivers  and  motors  so  dynamic  compensation  may  be  conveniently  added  later. 


CHAPTER  3 
EXTERNAL  ACTIVE  COMPENSATION 


As  mentioned  previously,  the  goal  of  this  research  is  to  minimize  positional  motion 
errors  of  the  robot.  This  is  a  huge  task,  and  a  number  of  variables,  some  unknown,  affect 
the  accuracy  of  the  robot.  One  method  of  undertaking  this  task  is  first  identifying  the 
limitations  of  a  particular  robot.  By  knowing  this  information,  a  plan  of  action  can  be 
established  to  eliminate  or  reduce  each  item.  Ideally,  the  robot  could  then  be  programmed 
to  compensate  for  these  errors.  However,  for  many  robots  this  may  not  be  practical  for 
two  reasons,  the  dynamic  response  of  the  robot  is  too  slow,  and  commanding  the  existing 
controller  to  provide  the  necessary  compensation  is  difficult.  In  this  section,  these  two 
factors  will  be  discussed. 

Investigations  of  the  servo  performance  of  the  shoulder  and  elbow  joints  of  the  Cincin- 
nati Milacron  T3-776  robot  revealed  rather  lethargic  reactions  to  step  inputs  in  position, 
and  will  be  further  explained  in  the  following  chapter  entitled  "Flexibility  Compensa- 
tion". This  slow  response  is  typical  not  only  for  the  shoulder  and  elbow  joints,  but  the 
base  and  the  wrist  joints  for  this  and  other  robots  have  similar  characteristics.  Presently, 
these  joints  can  respond  effectively  to  step  inputs  in  position  no  faster  than  approximately 
two  seconds.  Their  performance  can  be  improved  somewhat  by  adjusting  or  tuning  the 
feedback  gains  of  the  controller  for  specific  motions  and  loads.  However,  even  with  the 
controller  optimaUy  tuned  for  a  certain  motion,  the  performance  of  the  robot  servos  would 
not  have  the  dynamic  capabilities  required  to  effectively  respond  to  some  compensation 
signals.  This  is  because  the  servomotor  cannot  produce  enough  torque  to  accelerate  the 
links  effectively.  The  dynamic  response  could  therefore  be  improved  by  using  servomotors 
which  produce  more  torque  or  by  reducing  the  inertia  of  the  link  to  accelrated.  Neither 
of  these  solutions  is  economically  feasible. 

Assuming  that  the  bandwidth  of  the  robot  servos  was  able  to  effectively  react  to 
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the  position  commands,  there  is  an  additional  problem.  Typically,  most  robot  software 
is  proprietary  or  poorly  documented  making  it  quite  difficult  to  introduce  the  proper 
compensatory  motions  to  the  individual  servo  controllers  in  software.  This  leads  to  the 
development  of  an  external  compensation  system,  which  does  not  rely  on  the  performance 
characteristics  of  the  robot  hardware  or  compatibility  of  the  controlling  software. 

In  this  section,  the  design  and  performance  evaluation  of  an  external  single  degree- 
of-freedom  wrist  mounted  position  compensator  will  be  presented.  The  design  criteria, 
components  and  evaluation  techniques  will  also  be  discussed. 

External  Compensation  Background 

Much  research  has  taken  place  about  positional  errors  of  robots,  including  the  origins 
of  these  errors  and  more  recently  methods  to  eliminate  these  errors  in  real  time.  A  vast 
majority  of  these  researchers  have  developed  the  necessary  tools  to  describe  these  errors 
but  few  have  developed  methods  to  actually  eliminate  these  errors.  Those  who  do,  may 
rely  on  recalibration  or  other  techniques  for  the  static  errors  of  the  robot  mechanism,  but 
for  the  dynamic  or  active  errors,  they  have  placed  the  burden  on  the  robot  servos.  For 
a  limited  number  of  small  direct  drive  assembly  robots,  this  may  be  acceptable,  but  for 
most  large  industrial  robots,  the  response  of  their  servos  will  fall  short  of  the  requirements 
which  are  necessary  to  eliminate  the  dynamic  errors. 

This  leads  to  add-on  devices  used  to  increase  robot  performance.  These  devices  can 
be  divided  into  three  major  categories,  passive,  active  and  independent  devices.  Passive 
devices  could  be  generally  described  as  fine  tuned  geometric  springs  which  are  generally 
located  between  the  wrist  flange  and  end  effector  of  the  robot.  A  well  known  device  is  the 
Remote  Center  Compliance  (RCC)  device  developed  by  Draper  Labs.  They  are  designed 
to  automatically  accommodate  for  linear  and/or  angular  errors  present  in  peg-in-the- 
hole  type  assembly  tasks,  [24].  These  positional  errors  produce  forces  which  cause  the 
compliant  device  to  deflect  in  a  way  that  the  assembly  forces  are  reduced.  By  the  nature 
of  the  passive  device,  the  assembly  forces  are  never  completely  eliminated;  however,  they 
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may  be  greatly  reduced  in  most  cases. 

The  next  category  of  add-on  devices  are  the  active  devices,  including  wrist  mounted 
force  sensors,  and  instrumented  RCCs  (IRCC).  These  devices  can  relay  the  forces  measured 
at  the  wrist  back  to  the  robot  controller  and  provide  "adaptive"  force  control.  Typically, 
force  feedback  is  interpreted  by  the  controller  and  the  robot  servos  are  commanded  to 
make  the  appropriate  adjustments.  This  method  of  control  is  useful  for  both  assembly 
and  machining  operations.  Again,  remember  that  this  method  of  force  control  relies  on 
the  dynamic  capabilities  of  the  robot  servos  to  eliminate  or  control  the  position  or  force 
as  required. 

Finally,  the  third  category  of  add-on  devices  is  the  independent,  actively  servoed  de- 
vice. The  general  concept  of  this  device  is  to  provide  small  amplitude,  high  resolution, 
high  bandwidth  motions  which  are  beyond  the  capability  of  the  larger  general  purpose 
manipulator.  These  devices  may  range  from  one  to  six  degrees-of-freedom  depending  on 
the  requirements  of  the  application.  A  review  of  such  active  end-effectors  will  now  be 
presented. 

First,  a  single  degree-of-freedom  system  will  be  presented.  Hill  [25]  presents  a  linear, 
pneumatically  operated  single  degree-of-freedom  device  which  has  been  successfully  tested 
for  bolt  and  retainer  ring  insertions.  The  stated  performance  characteristics  for  this  device 
are: 

•  88  lb  (387  N)  capacity 

•  1  inch  (25.4  mm)  travel 

t  7  ounce  (1.93  N)  back-driveability 

No  indication  of  of  the  bandwidth  or  positional  resolution  is  provided  although  accu- 
racies to  a  thousandths  of  an  inch  are  implied.  Displacement  measurements  are  provided 
by  a  LVDT  sensors  and  force  measurements  are  obtained  by  a  pressure  transducer  located 
on  the  pressure  cylinder. 

A  two  degree-of-freedom  active  end-effector  was  developed  by  Stanford's  Aerospace 
Robotics  Laboratory  to  provide  force  control  for  a  very  flexible  manipulator,  [26].    A 
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Figure  3.1:  IBM  X-Y  Positioning  Device  (Adapted  from  [27]) 

five  bar  mechanism  was  used  to  provide  the  necessary  motion  of  tlie  end-effector  and 
two  electric  servomotors  were  used  to  provide  the  necessary  torque  inputs.  A  decoupled 
controller  was  used  to  independently  control  the  motion  of  end-eifector,  and  force  control 
with  a  10  Hz  bandwidth  was  possible.  This  active  device  improved  the  force  control 
bandwidth  ten  times,  from  the  original  1  Hz  capability  of  the  flexible  manipulator  alone. 
Force  capabilities  of  approximately  15  grams  were  available.  The  positional  resolution  of 
the  device  was  not  mentioned. 

Another  two  degree-of-freedom  active  end-effector  was  developed  by  IBM  for  fine  po- 
sitioning capabilities,  [27,28].  This  device  had  the  following  characteristics  listed: 

•  2.91b  (12.8  N)  capacity 

•  0.071  inch  (1.8  mm)  range 

•  0.00002  inch  (0.00051  mm)  resolution 


Innovative  design  characteristics  include  a  two  dimensional  electromagnetic  motor, 
flexural  leaf  spring  suspension  and  non-contact  LED  internal  positioning  system,  see  Fig- 
ure 3.1.  The  flexural  springs  allow  relative  motion  without  wear,  friction  and  backlash, 
which  are  characteristics  of  more  traditional  servo  systems. 
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Figure  3.2;  Active  End-Effector  Using  Four-Bar  Linkages  (Adapted  from  [31]) 

Currently,  two,  3  degree-of-freedom  active  end-effectors  are  under  development  at  Stan- 
ford University,  [29].  These  devices  are  to  provide  industrial  robots  the  ability  to  perform 
innovative  workpiece  acquisition  and  mating  tasks.  The  first  design  uses  four  bar  linkages 
to  provide  motion  in  the  X-Y  plane  and  a  linear  slide  for  motion  in  the  Z  direction,  see 
Figure  3.2.  The  second  design  uses  three  linear  slides  attached  in  series  to  provide  the 
motions  in  the  X-Y-Z  directions.  Both  designs  rely  on  the  supporting  industrial  robot  for 

any  required  rotational  motions.  The  design  specifications  are  listed  below: 

•  0.168  inch  (4.26  mm)  range  in  X,Y,Z  directions 

•  9.4  in/sec  (239  mm/sec)  maximum  speed 

•  10  lb  (44  N)  load  capacity 

•  0.0004  inch  (0.01  mm)  resolution 


A  survey  of  commercially  available  actuators  was  made,  and  it  was  found  that  com- 
mercially available  electric  actuators  did  not  meet  the  design  criteria.  As  a  result,  custom 
actuators  will  be  required  for  this  device. 

Van  Brussel  et  al.  [30]  developed  a  prototype  six  degree-of-freedom  hydraulically 
operated  device,  which  provides  fine  positioning  capabilities.  The  device  incorporated 
internal  force  sensing  capabilities.  No  specific  performance  characteristics  were  listed  in 
the  document. 


Mounting  Plate 
for  End-Effectcr 
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Figure  3.3:  Kinematic  Representation  of  the  Micromanipulator  (Adapted  from  [31]) 


The  Center  for  IntelUgent  Machines  and  Robotics  (CIMAR)  at  the  University  of 
Florida  has  been  engaged  in  developing  the  kinematic  design  of  a  six  degree-of-freedom 
parallel  type  device  for  fine  motion  or  force  control  [31].  This  device  has  been  named  a 
micromanipulator.  Based  on  a  parallel  mechanism  similar  to  the  Stewart  Platform,  the 
device  is  specifically  designed  for  small  motions.  As  illustrated  in  Figure  3.3,  the  end  of 
each  leg  is  is  connected  to  a  four-bar  mechanism.  The  desired  platform  motion  is  provided 
by  driving  the  six  independent  rotary  inputs.  The  four  bar  linkages  are  used  to  increase 
the  mechanical  advantage  of  the  inputs  and  to  improve  the  positional  resolution  of  the 
output.  A  set  of  performance  specifications  has  been  suggested  for  the  initial  prototype 
design: 

•   100  lb  (440  N)  load  capacity 
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•  +/-  0.1  in  (2.54  mm)  translation 

•  +/-  2  degree  rotation 

•  1  part  in  1000  resolution 

•  50  Hz  maximum  bandwidth 

•  6  in  (152  mm)  diameter,  6  in  length  (152  mm) 

The  load  capacity  which  has  been  suggested  corresponds  to  a  much  lower  bandwidth 
operation  than  the  50  Hz  stated  above.  For  those  applications  requiring  higher  band- 
widths,  the  load  requirement  will  have  to  be  relaxed  somewhat,  [31]. 

Most  of  the  work  on  active  end-effectors  has  been  aimed  at  improving  the  assembly 
capabilities  of  industrial  robots.  In  these  tasks,  the  actual  assembly  process  is  time- 
independent  and  the  variation  in  the  contact  forces  are  generally  well-behaved.  For  time 
independent  tasks,  such  as  light  machining  operations,  the  variations  in  the  contact  forces 
can  be  extreme,  due  to  the  dynamic  cutting  forces  at  the  tool.  This  provides  a  challenging 
application  for  active  end-effector  devices,  [31].  It  is  with  this  knowledge  that  the  single 
degree-of-freedom  active  end-effector  was  designed  and  installed  on  the  T3-776  robot. 

Design  Criteria  of  Position  Compensator 

To  reduce  the  problems  associated  with  an  internal  compensation  scheme,  an  external 
means  of  compensation  was  investigated  and  found  to  have  several  distinct  advantages: 

•  The  added  compensator  needs  only  a  short  travel  equal  to  the  maximum  positional 
error  of  the  robot. 

•  The  compensator  can  be  designed  for  quick  response  and  optimal  dynamic  charac- 
teristics. 

•  An  external  compensator  can  be  designed  to  provide  greater  positional  resolution 
than  that  of  the  robot. 

•  The  controller  for  the  compensator  is  completely  separate  from  the  robot  controller 
making  this  method  of  compensation  universally  applicable  to  other  types  of  robots. 


• 
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The  computational  requirements  for  the  compensation  are  greatly  reduced.  Com- 
pensatory displacements  at  the  tool  do  not  have  to  be  back  transformed  to  the  robot 
joint  coordinates. 

•  To  implement  the  compensation,  only  the  displacement  error  has  to  sent  to  the 
compensator. 

•  The  displacement  error  could  be  computed  by  the  compensator  controller  using  tool 
displacement  information  from  the  robot  and  external  sensor  information. 

•  This  external  compensator  could  also  be  used  in  a  force  control  mode  for  deburring, 
grinding  or  other  applications  requiring  force  control. 

From  the  above  list  and  specific  characteristics  of  the  T3-776  robot,  design  require- 
ments for  the  external  compensator  were  formulated  and  listed  below: 

•  Limited  travel  of  +/-  0.04  inch  (1  mm). 

•  Minimum  positional  bandwidth  of  7  Hz. 

•  Positional  resolution  of  0.001  inch  (0.025  mm)  or  better. 

•  Use  an  independent  controller. 

•  Produce  a  minimum  of  200  lb  (90  Kg)  force  output. 

•  Rugged  design  for  harsh  industrial  environment. 

•  Utilize  off-the-shelf  components  for  low  cost. 

With  these  requirements  used  as  a  guideline,  the  design  of  the  compensator  com- 
menced. 

For  edge  milling,  the  original  application  of  the  external  compensator,  only  a  single 
degree-of-freedom  must  be  accurately  controlled,  ie.  the  direction  normal  to  the  desired 
contour  of  the  workpiece.  Only  displacement  errors  normal  to  the  desired  motion  of  the 
tool  would  affect  the  accuracy  of  the  workpiece.  Because  the  robot  has  six  degrees-of- 
freedom,  the  orientation  of  the  cutting  tool  could  always  be  maintained  normal  to  the 
desired  motion  of  the  cut.  A  prismatic  joint  or  slider  could  be  attached  to  the  end  effector 
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of  the  robot  and  could  provide  the  necessary  compensatory  displacement  or  force  in  the 
direction  normal  to  the  cut  [32]. 

Several  different  methods  of  providing  the  necessary  linear  motion  were  investigated: 

•  Linear  displacement  systems  with  stepper  type  actuators. 

•  Precision  slide  table  with  recirculating  ball  screw  movement  and  stepper  motor  ac- 
tuator. 

•  Precision  slide  table  with  cam  and  roller  follower  movement  and  high  torque  pancake 
motor  actuator. 

The  first  two  methods  allow  precision  displacement  control  of  the  slide  table  with  rel- 
atively large  displacement  capabilities,  6  to  12  inches  (150  to  .300  mm)  typical.  However, 
the  maximum  displacement  required  from  the  compensator  will  be  0.08  inch  (2.0  mm)  or 
less  because  in  the  worse  case,  with  the  robot  fully  extended  with  the  maximum  rated  load 
of  200  pounds  (90  Kg)  applied,  the  maximum  deflection  of  the  end  effector  is  0.044  inch 
(1.1  mm).  This  makes  the  large  displacement  capabilities  unnecessary.  Also,  these  method 
allow  only  moderate  forces  to  be  applied  (or  absorbed)  and  this  limits  the  potential  capa- 
bilities of  the  robot  with  a  200  pound  (90  Kg)  load  rating. 

The  requirements  of  high  accuracy,  large  force  generation  capabilities  and  limited 
displacement  are  well  within  the  capabilities  of  a  linear  rise  cam.  Thus,  the  linear  rise 
cam  was  selected  for  the  following  reasons:  the  ability  to  quickly  transmit  large  forces,  the 
simplicity  and  ruggedness  of  the  transmission,  the  high  positional  accuracy  and  perceived 
cost  benefits. 

Mechanical  Design  of  Compensator 

In  this  section,  a  brief  description  of  the  mechanical  components  of  the  single  degree- 
of-freedom  compensator  will  be  presented.  Figure  3.14  reveals  the  components  of  the 
mechanical  servo  assembly.  The  prime  mover  is  a  DC  pancake  type  motor,  manufactured 


78 


position    table 


an. 


Figure  3.4:  Mechanical  Diagram  of  External  Compensator  (Adapted  from  [8]) 


by  PMI  Motors,  model  number  U12M4HT.  It  is  capable  of  producing  a  peak  torque  of 
1846  oz  in  (13  Nm)  and  a  continuous  torque  of  171.1  oz  in  (1.2  Nm)  and  because  of  its 
pancake  type  construction,  the  moment  of  inertia  is  small,  0.028  oz  in  sec^  (0.0002  Nm 
sec^).  The  motor  also  contains  an  integral  tachometer  and  1000  bit  per  revolution  encoder. 

The  output  shaft  of  the  motor  is  connected  to  the  cam  shaft  by  a  timing  belt  assembly, 
with  a  2.44:1  gear  reduction.  The  timing  belt  is  effective  in  reducing  the  load  torque 
perceived  by  the  motor  and  further  increases  the  positional  resolution  of  the  system.  The 
steel  camshaft  is  3.15  inch  (80  mm)  long  with  an  unsupported  span  of  2.28  inch  (58  mm) 
and  has  a  diameter  of  0.79  inch  (20  mm).  The  shaft  is  supported  by  a  set  of  single  row 
angular  contact  ball  bearings  with  a  contact  angle  of  30  degrees.  The  lower  cam  shaft 
bearing  is  placed  in  a  blind  hole  seat,  while  the  upper  bearing  is  preloaded  by  a  cover 
plate.  The  cam  and  the  timing  sprocket  are  held  in  place  by  a  setting  nut,  which  is  used 
to  force  the  components  against  a  shaft  seat. 

The  linear  rise  cam,  is  used  to  transmit  the  rotary  motion  produced  by  the  motor  to 
the  linear  motions  required  by  the  linear  slide  table.  The  cam  has  a  diameter  of  1.57  inch 
(40  mm),  and  a  linear  rise  of  0.078  inch  (2  mm)  over  a  rotation  of  350  degrees.  A  spring 
loaded  roller  cam  follower  is  directly  attached  to  the  linear  positioning  table.  The  spring 
applies  enough  pressure  so  that  the  follower  is  always  preloaded  against  the  cam.  The 
linear  positioning  table  has  a  maximum  travel  of  1.0  inch  (25.4  mm)  and  is  equipped  with 
two  sets  of  pre-loaded,  crossed  roller  bearings  for  increased  lateral  stiffness. 
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External 
Compensator 


Figure  3.5:  External  Compensator  Mounted  on  Robot 


A  bracket  was  designed  to  rigidly  attach  the  high  speed  pneumatic  router  to  the  slide 
table.  The  router  was  manufactured  by  Dotco  Inc.,  model  number  11T4318A-62,  and 
has  a  rated  output  of  2  horsepower  (1.5  Kw)  at  18000  RPM.  The  servomotor  and  the 
linear  positioning  table  were  rigidly  mounted  to  the  base  plate.  Finally,  the  entire  timing 
belt  assembly,  cam  shaft,  cam  and  follower  were  enclosed  by  the  side  plates,  upper  plate, 
and  the  base  plate.  These  plates  were  manufactured  of  aluminum,  and  provide  a  rigid 
structure  for  the  compensation  mechanism. 

Most  of  the  components  were  manufactured  by  the  in-house  machine  shop  at  the 
University  of  Florida  from  engineering  drawings  developed  by  E.  Stern  and  modified  as 
required  by  the  author.  In  addition,  the  linear  rise  cam  was  made  on  a  White  Sundstrand 
CNC  vertical  milling  machine  located  in  the  Machine  Tool  Laboratory  at  the  University 
of  Florida.  A  representative  drawing  of  the  external  compensator  mounted  on  the  robot 
is  shown  in  Figure  3.5. 
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Figure  3.6:  Schematic  of  Original  Compensator  Controller 


Electronic  Components  of  Compensator 


This  section  will  provide  an  overview  of  the  electronic  components  of  the  compen- 
sator including  the  servo  controller,  encoder  counter  circuit,  computer  interface  and  the 
force/torque  dynamometer.  Figure  3.6  provides  a  schematic  overview  of  the  original  con- 
trolhng  method  of  the  compensator.  Forces  measured  at  the  robot's  wrist  dynamometer 
were  sent  to  the  controlling  computer,  via  a  parallel  port.  The  estimated  deflection  of 
the  robot,  Xd,  was  calculated  by  multiplying  a  predetermined  flexibility  matrix  by  the 
measured  forces  in  the  main  computer.  Through  a  shared  memory,  A''^  was  sent  to  the 
satellite  computer,  where  the  actual  position,  Xa,  was  subtracted  from  Xd-  The  result 
was  Xe,  the  positional  error  and  it  was  converted  to  an  analog  signal  and  this  signal  was 
used  by  the  servo  amplifier  to  control  the  position  of  the  servomotor. 

The  servo  system  was  controlled  by  a  pair  of  16  bit  micro-computers.  The  main 
computer  was  a  Digital  Equipment  Corporation  PDP-11/23-03  and  its  primary  function 
was  to  calculate  the  desired  compensatory  displacement  for  the  servo  system.  The  force 
vector,  F^,  provided  in  real  time  (100  Hz),  was  multiplied  via  a  FORTRAN  program  by 
the  flexibility  matrix,  FLEX,  and  the  product  was  Xd-  The  PDP-11/03  satellite  computer 
was  used  for  data  acquisition  and  release  and  computing  the  positional  error  command, 
Xe,  via  a  MACRO  program.  The  main  and  satellite  computers  communicated  through 
4096  bytes  of  shared  memory.    A  Datel  data  conversion  unit  provided  analog  to  digital 
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(A/D)  and  digital  to  analog  (D/A)  functions  and  was  interfaced  to  the  PDP-11/03.  The 
input  of  the  servo  amplifier  was  provided  by  one  of  the  12  bit  D/A  converters. 

During  the  real  time  operation  of  the  system,  the  shared  memory  was  used  to  pass 
data  between  the  two  computers.  When  one  processor  accessed  the  shared  memory,  an 
on-board  arbitrator  locked  out  the  other  processor.  Upon  the  completion  of  the  read  or 
write  operation,  the  other  processor  was  given  access  to  the  memory  if  it  had  been  waiting. 
The  shared  memory  simplified  the  interfacing  software  since  both  computers  could  operate 
asynchronously.  Both  the  main  and  satelUte  computers  ran  their  respective  programs  at 
approximately  100  Hz. 

A  Digital  Equipment  Corporation  DRV-llJ  board  was  used  as  the  parallel  interface  to 
the  PDP-11/03.  The  four  programmable  ports  on  the  DRV-llJ  contain  16  I/O  lines  and 
are  capable  of  transferring  16  bit  words  between  the  LSI-11  bus  of  the  PDP-11/2.3-03  and 
the  connecting  devices.  Handshake  lines  between  the  external  devices  and  the  DRV-llJ 
ensure  accurate  data  transfer.  Port  A  on  the  Jl  pin  connector  took  data  from  the  wrist 
dynamometer  and  Port  D  on  the  J2  connector  was  connected  to  the  counter  circuit  of  the 
encoder. 

The  servo  amplifier  PMI  model  SSSA  41-10-30,  is  a  four  quadrant  pulsed  width  mod- 
ulated (PWM)  servo  amplifier  designed  to  drive  the  permanent  magnet  DC  servomotor 
described  earlier.  With  three  input  channels  to  the  comparator  amplifier,  the  position  com- 
mand signal  directed  to  channel  one,  having  the  maximum  gain  input.  The  accelerometric 
compensation  signal  was  sent  to  channel  two  and  tachometer  output  (velocity  feedback) 
was  directed  to  channel  three,  which  had  the  lowest  gain.  The  tachometer  which  had 
an  output  constant  of  8.10  volt/lOOG  RPM  was  of  course  connected  to  provide  negative 
feedback. 

The  encoder,  PMI  model  M23-1000-ABI-5  provides  1000  counts  per  revolution.  It 
incorporates  a  LED  light  source  and  a  monolithic  radial  phototransistor  array.  The  output 
produces  two  channels  of  square  wave  pulses  which  are  90  degrees  phase  shifted.  For  one 
counting  cycle,  four  'checks'  are  made  to  determine  direction  and  count. 
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Figure  3.7:  16  Bit  Counter  Circuit 


A  16  bit  counter  was  used  to  close  the  positional  loop,  Figure  3.7.  Originally,  an  INTEL 
2716,  a  16  K  erasable  prom  (EPROM),  was  used  to  determine  whether  the  encoder  outputs 
were  counts  up  or  down.  The  2716  was  later  replaced  by  a  pair  of  nand  gates  after  several 
instances  of  memory  loss.  The  latched  output  is  then  sent  to  a  16  bit  cascading  counter 
comprised  of  four  MSI  LS193  synchronous  up/down  counters.  The  output  of  the  counters 
is  sent  to  another  buffer  before  being  sent  to  the  digital  port  of  the  controller.  Hand 
shakes  are  required  before  the  data  in  the  buffers  are  dumped.  The  latches  are  necessary 
to  prevent  lost  counts,  for  example,  if  the  encoder  output  was  changing  as  it  was  being 
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sampled.   A  5  MHz  clock  synchronized  the  latched  buffers.   A  manual  reset  switch  was 
provided  so  that  the  counters  and  buffers  could  be  set  to  zero. 

The  force/torque  dynamometer  used  was  a  Robot  Sensor  Systems,  Incorporated  model 
150/600.  The  sensor  has  a  force  resolution  of  1  pound  (0.45  Kg)  over  a  +/-  150  pound 
(68.2  Kg)  range  and  a  torque  resolution  of  1  pound-inch  (0.0117  Kg-m)  over  a  600  pound- 
inches  (7.0  Kg-m)  range.  The  dynamometer  incorporates  a  six  degree-of-freedom  sensor 
frame  which  is  instrumented  with  strain  gauges.  The  strain  gauge  frame  is  flexible  in 
nature  and  introduces  additional  variables  to  the  flexibility  model  of  the  robot. 

The  force/torque  sensor  has  two  potential  sources  of  error  which  should  be  modeled 
and  taken  into  account  for  various  tasks.  The  first  is  the  flexibility  of  the  sensor  frame,  the 
second  is  a  backlash  associated  with  the  dynamometer  mount.  The  flexibility  of  the  sensor 
was  not  originally  taken  into  account,  and  some  displacement  errors  could  not  be  originally 
accounted  for.  These  errors  were  finally  traced  to  the  sensor  frame.  The  flexibility  of  the 
sensor  frame  was  statically  measured  by  applying  forces  and  measuring  the  displacement 
with  a  capacitance  probe.  Figure  .3.8  shows  the  static  flexibility  measurement  setup.  The 
force  was  incrementally  increased  by  adding  weights  to  the  system  and  the  displacement  of 
both  the  robot  wrist  flange  and  the  tool  was  measured.  The  difference  of  the  displacements 
was  automatically  produced  by  the  capacitance  probe  electronics  and  manually  recorded 
for  each  increment  force.  The  slope  of  the  plot  revealed  a  flexibility  of  approximately 
1.6*10''  in/lb  (92.2  m/N).  The  flexibility  of  the  sensor  was  measured  only  in  the  direction 
parallel  to  the  sliding  motion  of  the  compensator,  labeled  the  positive  Y  direction  on  the 
sensor  frame.  The  flexibility  of  the  sensor  frame  is  the  same  order  of  magnitude  to  that 
of  the  robot,  so  it  should  be  included  in  the  flexibility  model. 

The  backlash  of  the  sensor  was  noticed  when  forces  were  applied  in  both  the  positive 
and  negative  Y  directions  in  sensor  frame  coordinates.  When  forces  were  applied  in  the 
positive  Y  direction,  the  sensor  was  displaced  because  of  its  internal  flexibilities.  When  no 
more  forces  were  applied  the  sensor  would  return  to  its  original  displacement.  However, 
when  a  force  was  applied  in  the  opposite  direction  (-Y)  the  displacement  would  jump 
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Figure  3.8:  Static  Flexibility  Measurement  of  Force  Sensor 

approximately  0.010  inch  (0.25  mm).  For  the  edge  milling  operation,  the  backlash  would 
not  effect  performance  of  the  compensator  because  forces  are  applied  in  only  one  general 
direction,  towards  the  compensator,  not  away  from  it.  For  other  applications,  the  backlash 
may  have  to  be  accounted  for. 

A  microprocessor  is  used  to  transform  the  force  transducer  data  into  Cartesian  force/torque 
components.  Two  communication  ports  are  provided  to  transmit  this  data  to  the  user:  an 
RS-232C  serial  interface  and  a  16  bit  TTL  compatible  interface.  The  serial  interface  is  used 
to  enter  system  commands  and  the  parallel  interface  is  used  to  transmit  the  force/torque 
data.  Resolved  data  strings  with  the  three  forces  and  three  torques  and  system  health  can 
be  transmitted  at  100-110  Hz  over  the  parallel  port.  Experience  demonstrates  the  need  of 
shielded  cables  for  the  transmission  of  parallel  data.  Without  the  proper  shielding,  bits 
are  lost,  aliasing  occurs  and  communication  between  devices  stops  or  the  data  becomes 
unintelligible. 

The  PDP  11/23-03  combination  was  used  for  several  reasons  including:    its  ability 
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Figure  3.9:  Schematic  of  Second  Generation  Controller 

to  provide  real  time  control,  much  of  the  required  hardware  was  readily  available  and 
the  author  was  familiar  with  its  operation.  This  method  of  control  worked  quite  well. 
However,  an  alternative  method  to  provide  the  control  of  the  compensator  was  required 
due  to  logistic  constraints,  the  T3-776  robot  was  being  moved  to  a  remote  location.  An 
IBM  PC/AT  was  used  to  replace  the  previous  computer  control  system. 

Figure  3.9  shows  the  second  generation  computer  controller.  The  block  diagram  is 
identical  except  for  the  computer  and  I/O  peripherals.  The  Datel  D/A  board  was  replaced 
by  a  Data  Translation  DT2801  board  with  12  bit  resolution.  The  DRV-llJ  board  was 
replaced  by  a  pair  of  Omnicomps  Graphics  Corporation  PCll  paxallel  boards.  The  PCll 
was  designed  to  emulate  the  operation  of  DRV-11  boards  in  a  PC  environment.  This 
method  of  control  provided  a  low  cost  alternative  as  compared  to  the  cost  of  duplicating 
the  prcYioufi  V\}V-\\l'M-^'i  cnntrnllcri  In  addition  to  hfiing  GQfit  (^ffoctive,  \Am  p^^rformance 
of  the  PC  based  controller  was  superior  to  that  of  the  PDP-11/23-03. 

Software  Components  of  Compensator 


To  complete  the  design  of  the  compensator,  controlling  software  was  developed.  The 
original  PDP-11/2.3-03  based  controller  utilized  four  different  programs  to  control  the 
compensator: 
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1.  A  Fortran  program  which  calculated  the  flexibility  coefficients  given  the  position  of 
the  end  effector,  this  program  ran  off-line. 

2.  A  Fortran  program  which  multiplied  the  flexibility  coefficients  by  the  measured  forces 
and  torques,  and  the  resulting  product  was  equal  to  the  desired  displacement  of  the 
compensator,  Xd- 

3.  An  assembly  program  which  acquired  the  force/torque  information  and  the  encoder 
position,  Xa- 

4.  An  assembly  program  which  compared  the  actual  encoder  position  to  the  desired 
position  and  the  difference,  X^  drove  the  compensator. 

The  first  program,  which  was  used  off-line,  produced  the  flexibility  coefficients  for  the 
robot  given  the  tool  coordinates.  This  program  would  be  implemented  to  provide  the 
flexibility  matrices  at  some  given  interval  along  the  entire  tool  path.  The  displacement  at 
the  tool  was  due  to  two  distinct  flexibilities,  flexibilities  of  the  robot  structure  and  of  the 
wrist.  The  flexibility  matrices  were  stored  and  at  the  appropriate  time  they  were  recalled 
manually.  Further  details  about  the  development  of  the  flexibility  matrix  can  be  found  in 
the  chapter  entitled  "Flexibility  Compensation". 

The  following  equation  was  used  in  the  second  program  to  calculate  the  desired  dis- 
placement for  the  compensator: 

[Disp]t  =  {[Flex],  +  [Flex]^)  *  [Force]j,  (3.1) 

[Disp]t  =  [Flex]  *  [Force]p  (3.2) 

where 

[Disp]^  -  the  required  compensation  displacement  at  the  tool 

[Flex]^  -  the  flexibilities  due  to  the  robot  structure 

[Force]     -  the  externally  applied  forces  at  the  end  effector  of  the  robot 

[Flex]^  -  the  flexibilities  due  to  the  wrist 
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[F/ea;]  -  the  combined  flexibility  matrix 

A  program  using  Equation  3.2  was  implemented  in  real  time  to  provide  the  required 
displacement  of  the  compensator  to  eliminate  the  displacement  errors  due  to  robot  flexi- 
bilities. Because  the  tool  position  was  not  revealed  to  the  controlling  computer  directly, 
the  position  dependant  flexibility  matrices  were  not  automatically  utilized  in  software. 
Instead,  the  flexibility  matrices  were  manually  transferred  to  the  interactive  controlling 
program.  This  did  not  present  a  major  problem  since  the  flexibility  matrices  changed 
only  gradually  over  the  tool  paths.  Cincinnati  Milacron  has  since  developed  a  software 
package  that  would  allow  a  DEC  type  system  to  communicate  with  the  robot  controller. 
The  Remote  Real  Time  Interface  would  allow  a  near  real  time  generation  of  the  flexibility 
matrices  to  be  produced  on-line. 

The  third  program  was  used  to  obtain  the  output  of  the  force/torque  microprocessor 
and  the  encoder  position  from  the  counter  circuit  and  put  the  values  in  the  shared  memory. 
The  forth  program  was  used  to  calculate  the  difference  between  the  desired  position, 
Xd.  and  the  actual  position  Xa  of  the  compensator.  The  difference,  A'e  was  sent  to  the 
D/A  converter  and  used  to  drive  the  servo  amplifier.  These  Macro  programs  ran  at 
approximately  200  Hz  or  twice  as  fast  as  the  force/torque  monitoring  system. 

These  Macro  programs  were  modeled  after  similar  routines  used  by  the  PDP-11/0.3  to 
control  the  MBA  robot  in  the  CIMAR  laboratory.  Different  addresses  had  to  be  used  for 
both  the  parallel  ports  and  the  D/A  port. 

When  the  controlling  computer  was  replaced  by  the  IBM  PC/AT,  the  software  was  re- 
written in  TurboPascal.  A  single  program  was  written  to  replace  the  three  final  programs 
described  previously.  The  flexibility  matrices  were  entered  manuaUy.  The  actual  working 
program  was  able  to  operate  at  approximately  300  Hz.  A  copy  of  this  program  can  be 
found  in  Appendix  D. 

In  both  sets  of  software,  an  algorithm  was  implemented  which  would  provide  a  smooth 
transition  about  origin  (or  initial  value)  of  the  counter.  Remember  that  digital  devices  such 
as  the  counter  do  not  provide  negative  numbers,  so  they  have  to  be  artificially  produced 
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Figure  3.10:  Block  Diagram  Representation  of  External  Compensator 

in  software.  For  example,  the  counter  circuit  has  a  useful  range  of  0  to  4095  counts,  or  12 
bits,  the  maximum  number  of  counts  required  for  a  complete  revolution  of  the  linear  rise 
cam.  When  the  cam  is  at  its  desired  origin,  at  the  center  of  the  linear  face,  the  counter 
circuit  was  reset  to  zero.  The  output  of  the  counter  about  the  origin  has  the  following 
series  output: 

....  4093  4094  4095  0123.... 

If  the  shaft  was  rotated  slightly  counter-clockwise,  the  out  put  of  the  counter  circuit 
would  jump  suddenly  from  values  approximately  equal  to  zero,  to  values  above  4000.  This 
would  cause  the  system  to  become  unstable.  A  subroutine  was  written  so  that  encoder 
values  greater  than  2048  would  have  the  number  4096  subtracted  from  it.  This  would 
place  the  non-linearity  in  the  counts  at  the  non-linear  step  in  the  surface  of  the  linear  rise 
cam,  which  was  intentionally  avoided.  The  series  took  on  the  following  structure: 

....  -3  -2  -1  0  1  2  3 2047  2048  -2047  -2046  .... 

Not  only  did  this  algorithm  stabilize  the  system,  but  it  also  allowed  negative  displace- 
ments to  be  commanded. 

Dynamic  Response  of  External  Position  Compensator 


To  predict  the  capabilities  of  the  servo  system,  it  was  first  simulated  with  an  ACSL 
program.  A  block  diagram  of  the  simulated  system  can  be  seen  in  Figure  3.10  and  most 
of  the  constants  were  provided  by  PMI  for  the  servomotor  and  servo  amplifier.    Non- 


89 


0.0M)&e 


RT  INPUT  LIN 

CH  1 

IX- 


INCHES 


DISPLfiCEMENT 

'        ■        '        ■        I        ■        '        ■        ■        f        ■        '        '        ' 


0.Q 


K- 


J 


TlMEtSEIC):      1.297 


: 1  ■     I       I 

LIN  TlflECSEC) 

ftMPL:    0.0U76 

0  REJ7        r 


T 1 r 


2,080 


Figure  3.11:  Simulated  Response  of  Active  Compensator  to  a  Step  Input 

linearities  such  as  the  current  limits  of  the  amplifier  are  easily  modeled  in  this  simulation 
environment.  Figure  3.11  is  tlie  simulated  positional  response  of  the  system  to  a  step 
input  in  position.  By  adjusting  the  position  and  velocity  gains,  significant  changes  can  be 
made  to  the  system  response,  as  expected. 

A  simple  control  program  was  first  written  to  evaluate  the  actual  positional  response 
of  the  servo  mechanism.  It  allowed  the  operator  to  input  a  desired  encoder  value,  which 
was  directly  related  to  the  displacement  of  the  slide.  The  displacement  of  the  slide  was 
measured  with  a  capacitance  probe  with  0.0005  inch  resolution,  and  then  recorded  real 
time  on  a  GenRad  datalogger.  As  can  be  seen  in  Figure  3.12,  the  servo  system  is  responsive 
when  compared  to  the  positional  step  response  of  the  robot.  The  following  parameters 
give  an  idea  of  the  response  of  the  closed  positional  loop: 

ts  -  2%  settling  time  of  0.15  sec  tp  -  peak  time  of  0.06  sec 

tr  -  rise  time  of  0.02  sec.  (10-90%)      tj,  -  delay  time  of  0.03  sec 
Mp  -  maximum  overshoot  of  15% 


Because  Figures  3.11  and  3.12  closely  resemble  each  other,  one  may  assume  that  an 
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Figure  3.12:  The  Actual  Response  of  the  External  Compensator  to  a  Step  Input 

accurate  model  of  the  servo  system  has  been  made.  An  accurate  model  is  useful  when 
simulating  other  control  techniques  without  having  to  build  actual  hardware  and  soft- 
ware prototypes.  In  fact  this  model  was  used  later  to  simulate  the  effectiveness  of  an 
accelerometric  compensation  scheme  designed  to  provide  additional  improvements  to  the 
positional  accuracy  of  the  robot. 

The  additional  compensation  slide  demonstrates  an  improvement  in  the  positional 
performance  as  compared  to  the  other  joints  of  the  robot.  Additionally,  the  increased 
positional  resolution  of  the  table  is  much  better  than  that  of  the  combined  positional 
resolution  of  the  robot.  The  optimum  resolution  of  the  external  compensator  can  be 
demonstrated  in  the  following  way: 

Dr  =  {Cr){Tr){T,}  (3.3) 

where 

Dr  -  displacement  resolution  of  (1,186  counts)/mm 

Ct  -  cam  rise  of  (2  mm)/(350  deg) 

Tr  -  timing  ratio  of  2.44:1 

Td  -  track  density  of  (360  deg)/(10G0  counts) 

Theoretically,  the  smallest  detectable  linear  motion  of  the  slide  table  would  be  approx- 
imately one  micron,  or  1/Dr-  Of  course,  the  accuracy  of  the  compensator  is  influenced  by 
the  flexibilities  in  the  mechanical  assembly  and  on  the  accuracy  of  the  cam.  The  linearity 
of  the  cam  was  tested  by  writing  a  program  which  would  increment  the  desired  position  of 
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Figure  3.13:  Linearity  Check  of  Cam  Surface 

the  table  by  one  count  per  cycle  in  the  control  program.  Again,  the  position  of  the  slide 
table  was  recorded  with  the  capacitance  probe  and  the  result  is  depicted  in  Figure  3.13. 
The  slope  is  nearly  linear,  implying  a  well  machined  cam,  which  provides  the  required 
linear  response. 

The  system  was  able  to  respond  quite  well  to  dynamic  inputs.  For  example,  a  sine  wave 
of  5  Hz  was  commanded  at  the  positional  input  of  the  system,  and  the  recorded  output  of 
the  positional  table  matched  the  input  with  little  phase  shift.  Overall,  the  capabilities  of 
the  compensator  were  quite  good  including:  fast  response,  excellent  resolution,  large  force 
output  and  durable  construction. 

External  Force  Compensation 


The  methodology  of  using  the  single  degree-of-freedom  compensator  for  position  com- 
pensation was  given  above.  The  device  accurately  provides  the  desired  displacement  of 
the  tool  in  a  rapid  manner.  This  external  compensator  could  also  be  used  to  control  exter- 
nal forces  for  grinding,  deburring  and  other  applications  requiring  accurate  force  control. 
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Several  researchers  have  described  force  control  strategies  for  robots,  where  some  imple- 
mentations are  strictly  force  controllers  and  others  are  hybrid  force/position  controllers. 
Whitney  [33]  presents  an  excellent  review  of  robot  force  control.   A  brief  description 
of  several  current  methods  of  current  force  control  strategies  will  now  be  presented. 

Hybrid  Position/Force  Control 

Hybrid  force/position  control  combines  force  and  torque  information  with  manipulator 
position  and  orientation  data  to  satisfy  simultaneous  position  and  force  constraints  [34]. 
Hybrid  position /force  control  partitions  the  various  degrees-of-freedom  of  the  robot  to  ei- 
ther force  or  position  control.  The  partition  is  dependent  on  the  mechanical  and  geometric 
constraints  of  the  performed  task  [35].  Position  constraints  exist  along  the  normal  to  a 
surface  where  the  presence  of  a  surface  constrains  the  range  of  motion.  Force  constraints 
exists  along  the  surface  tangents  where  it  is  impossible  to  apply  arbitrary  forces. 

Obviously,  in  free  space,  the  robot  has  no  constraints  and  thus  has  six  positional 
degrees-of-freedom.  However,  if  the  end  effector  was  fixed  to  ground,  there  would  be 
no  positional  degrees-of-freedom,  but  an  arbitrary  force  could  be  applied  in  any  direction. 
Figure  3.14  shows  five,  four,  and  three  degrees-of-freedom  position  constraints.  Conversely, 
the  figure  also  illustrates  one,  two  and  three  degrees-of-freedom  force  constraints.  The 
constraint  space  does  not  directly  coincide  with  the  joints  of  the  manipulator.  It  is  a 
six  degree-of-freedom  Cartesian  system  defined  with  respect  to  the  task  geometry,  with 
i  degrees-of-freedom  dedicated  to  position  constraints  and  6,-  degrees-of-freedom  for  force 
constraints. 

R.aibert  and  Craig  [37]  developed  a  hybrid  controller.  The  position  of  the  end  effector 
was  monitored  by  the  factory  instaUed  joint  encoders  or  resolvers.  The  force  was  monitored 
by  a  wrist  mounted  force/torque  sensor.  Position  and  force  errors  were  multiplied  by  a 
compliance  selection  matrix  which  informed  the  controller  whether  degrees-of-freedom  of 
the  task  were  position  or  force  constrained.  The  actuator  control  signal  for  the  f"'  joint 
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Figure  3.14:  Constrained  End  Effector  Freedom  of  Motion,  a)  Five  DOF.  b)  Four  DOF. 
c)  Tliree  DOF.  (Adapted  from  [36]) 


has  six  components  from  the  constraint  space  for  the  six  degree-of- freedom  robot: 

6 

T^^Y1  Ttj-t^j^/;]  +  *=.[(1  -  ^j)^^j]  (3.4) 

where 

Ti  -  torque  applied  to  the  ?*''  actuator 

A/j  -  force  error  in  the  jf*^  DOF  of  constraint  space 

Axj  -  position  error  in  the  _;'''  DOF  of  constraint  space 

F,.,-  -  force  compensation  function  for  j*''  input  and  the  iti^'^  output 

^ij  -  position  compensation  function  for  j*''  input  and  the  iti'^'^  output 
Sj  -  component  of  the  compliance  selection  output 

The  compliance  selection  vector,  S,  is  a  binary  N-tuple  that  specifies  which  degrees-of- 
freedom  in  the  the  constraint  frame  are  under  force  control  and  which  are  under  position 
control  [34].  For  example,  if 

5  =  [0,0,1,0,1,1]  (3.5) 
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then 

T,     =     *.i(Aari)  +  *.-2(Aa:2)  +  r.3(A/3)+  (3.6) 

*.-4(Aa;4)  +  r.-5(A/5)  +  T,e{^fe) 

Though  the  total  number  of  active  control  loops  is  always  six  (for  a  six  axis  robot)  the 
type  mix  will  vary  as  the  task  geometry  and  constraints  change. 

Hybrid  position/force  control  requires  an  explicit  description  of  the  workpiece  in  terms 
of  position  and  force  constraints.  This  description  may  be  conceptually  straight  forward, 
for  example,  a  deburring  operation  may  require  a  constant  force  of  1.1  lb  (5  N)  to  be  ap- 
plied in  the  normal  direction  while  traveling  at  a  tangential  speed  of  2  in/sec  (5  cm/sec). 
Translating  these  conceptual  constraint  descriptions  into  a  form  the  control  system  un- 
derstands is  computationally  difficult  for  all  but  the  simple  tasks.  Developing  a  method 
to  derive  the  compliance  selection  vector  is  the  major  limitation  to  this  type  of  control. 
In  addition,  accurate  models  of  the  controller  must  be  developed  or  provided  before  the 
force  control  can  be  effectively  implemented. 

Compliant  Control 

Compliaiit  control  is  a  position/force  control  method  similar  to  hybrid  control.  In 
certain  respects,  hybrid  control  is  a  modification  and  extension  of  compliant  control,  de- 
veloped by  Paul  [20].  Both  approaches  employ  a  task  related  constraint  vector  and  they 
use  this  constraint  to  partition  the  system  into  position  and  force  controlled  subspaces. 
Force  and  position  may  both  be  specified  at  the  end  eifector.  However,  in  this  imple- 
mentation, some  robot  joints  are  used  to  provide  position  control  and  the  others  are  used 
to  provide  the  necessary  force  control.  This  method  usually  results  in  both  position  and 
force  errors  which  are  corrected  on  subsequent  cycles  by  adjusting  the  position  and  force 
set  point. 

This  method  eliminates  the  need  of  transforming  the  constraint  vector  as  required  by 
the  hybrid  control  scheme.  For  some  tasks,  certain  joints  of  the  robot  would  be  selected 
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for  force  control  and  for  other  tasks  a  different  group  of  joints  may  be  selected  for  force 
control,  while  the  remainder  are  used  for  position  control. 

Joint  Torque  Control 

Joint  torque  control  is  a  method  which  allows  force  control  at  the  robot  end  effector  by 
monitoring  the  torques  at  the  individual  joints  of  the  robot.  This  is  an  example  of  internal 
force  control,  where  the  joint  actuators  of  the  robot  are  directed  to  provide  the  proper 
force  at  the  end  effector.  Because  the  force  of  the  end  effector  is  controlled  explicitly, 
position  control  can  not  be  specified  for  the  end  effector.  Neglecting  gravity  and  friction 
and  assuming  a  static  case,  the  forces  at  the  end  effector,  Fg  are  related  to  the  joint,  Ti 
torques  by  the  inverse  of  the  Jacobian  [J]  transpose: 

Fe  -  [J]-^T,  (3.7) 

This  allows  the  forces  at  the  end  effector  to  be  easily  controlled  for  this  simple  example. 
For  an  ideal  dynamic  system,  with  no  friction  or  gravity  effects,  the  torque  equation 
becomes  quite  complex  and  includes  position  dependant  matrices  [P*]  and  [/*]  related  to 
joint  velocity  (p  and  joint  acceleration  (p  respectively: 

r,  =  [jfF,  +  <^[P10^  +  [r]0  (.3.8) 

The  force  at  the  end  effector  can  conceivably  be  calculated  by  using  a  form  of  the  above 
equation,  but  the  [P*]  and  [J*]  matrices  are  difficult  to  accurately  model  and  implement 
in  a  real  time  controller. 

After  measuring  the  joint  torques  and  computing  the  applied  force  at  the  end  effector, 
the  difference  between  the  applied  and  desired  force  would  be  used  to  drive  the  servo 
mechanism  in  a  torque  control  fashion.  Strain  gauges  located  at  each  joint  could  directly 
measure  the  joint  torques,  or  torque  observers  could  be  used  instead.  The  driving  torque 
for  the  system  would  be  the  difference  between  the  actual  and  desired  torques  for  the 
joints,  ie: 

T,,  =  T,a  -  {[jfF,,  +  un'i^d  +  [n4>d)  (3.9) 
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where  the  subscript  a  denotes  actual  values  and  d  denotes  desired  values.  With  this 
equation,  the  forces  produced  at  the  end  effector  are  only  approximate,  errors  in  the 
torque  equation  will  introduce  definite  errors  in  the  force  produced  at  the  end  effector. 
However,  if  the  force  was  directly  measured  at  the  end  effector,  the  force  errors  would 
be  directly  known  and  these  values  could  be  used  to  drive  the  servos  with  the  following 
equation: 

r,,  -  [jf{F,a  -  F,d)  +  (0a  -  ^d)[P']{4>a  "  4>df  +  [Hik  '  4>d)  (3.10) 

and  for  slow  motions,  where  the  effects  of  [P*]  and  [/']  become  small,  the  above  equation 
could  be  simplified  to: 

r,e  =  [jf{Fea  -  F,d)  (3.11) 

Joint  torque  control  has  several  limitations,  it  can  only  provide  force  control,  no  po- 
sition control;  the  actual  equations  relating  joint  torques  to  end  effector  forces  and  vice 
versa  are  more  complex  than  just  presented,  because  the  actual  system  contains  gravity 
and  frictional  effects  as  well.  The  complex  [P*]  and  [/']  matrices  must  be  calculated  in 
real  time  for  true  dynamic  applications. 

Pure  Force  Control 

Pure  force  control  is  similar  to  joint  torque  control  in  that  forces  at  the  end  effector  are 
controlled.  This  is  also  an  internal  force  control  method,  where  the  robot  actuators  are 
controlled  to  provide  the  necessary  applied  force  at  the  end  effector.  A  force  sensor  is  used 
at  the  wrist  to  sense  the  actual  end  effector  forces.  These  measured  forces  are  compared 
to  the  forces  desired  at  the  end  effector  and  their  difference  is  used  to  drive  the  robot.  A 
simple  equation  is  used  to  relate  the  necessary  displacement  of  a  single  degree-of-freedom 
system  to  eliminate  a  force  error: 

X  =  ^^^  (3.12) 

where  fa  is  the  actual  force  measured  at  the  end  effector,  fd  is  the  desired  force  at  the 
end  effector,  k  is  the  structural  stiffness  of  the  robot  structure  and  x  is  the  displacement 
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required  to  eliminate  the  force  error.  For  complex  structures,  a  robot  for  example,  the 
above  equation  is  expanded  to: 

xi  =  [STIFF]-'F,  (3.13) 

Where  [STIFF]  is  a  position  dependent  matrix  used  to  describe  the  stiffness  of  the  robot, 
or  in  a  form  that  will  be  used  later  in  the  section  on  flexibilities: 

X.  =  [FLEXjFi  (3.14) 

where  [FLEX],  the  position  dependent  flexibility  matrix  is  the  inverse  of  the  stiffness 
matrix  and  Fi  is  the  applied  force.  The  force  would  actually  be  a  combination  of  three 
forces  along  the  fixed  Cartesian  coordinate  frame  at  the  wrist  and  three  torques  about 
those  axes.  In  addition,  the  flexibility  matrix  [FLEX]  is  position  dependant  and  would  have 
to  be  accurately  modeled  for  real  time  control.  The  displacements  Xi,  actually  represent 
linear  and  rotational  displacements  at  the  end  effector.  The  displacements  values  at  the 
wrist  would  then  have  to  be  back  transformed  to  joint  coordinates,  and  the  traditional 
position  controlled  joints  could  properly  respond.  Figure  3.15  illustrates  the  force  control 
scheme  for  a  typical  robot  controller.  The  force  loop  is  external  to  the  standard  position 
control. 

During  typical  positional  control,  the  force  feedback  gain  matrix  G'l,  would  be  set 
to  zero  and  the  positional  input  gain  matrix  G2,  would  be  set  equal  to  the  identity  ma- 
trix. The  desired  end  effector  position  vector  X^j,  would  be  transformed  to  desired  joint 
positions  Qu,  through  Qed  using  the  standard  Jacobian  method  as  seen  in  the  following 
equation: 

Q,H  =  [J]'^X,d  (3.15) 

The  difference  between  the  desired,  0,^  and  actual  joint  position,  Q,a,  would  be  used  to 
drive  the  servos.  The  actual  end  effector  position,  X^a  should  be  exactly  known  because  the 
actual  positions  of  the  individual  joints  are  known  and  the  end  effector  of  the  manipulator 
is  kinematicaUy  constrained  to  be  at  a  given  location  by  the  following  relationship: 

Xea  =  [J]~'^Q,a  (3.16) 
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Figure  3.15:  Force  Control  for  Typical  Robot  Control  Architecture 
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When  operating  in  the  pure  force  control  mode,  the  force  feedback  gain  matrix,  d 
would  be  set  equal  to  the  identity  matrix  and  the  positional  input  gain  matrix,  G^  would 
be  set  to  zero.  Forces  at  the  end  effector  F^^,  would  be  measured  and  compared  to  the 
desired  end  effector  forces  F^d,  and  the  difference  would  be  multiplied  by  the  inverse  of  the 
position  dependant  stiffness  matrix,  [FLEX]  otherwise  known  as  the  flexibility  matrix. 

If  the  stiffness  of  the  robot  was  accurately  modeled,  so  that  actual  structural  stiffness, 
Ka  was  equal  to  the  modeled  stiffness,  Km  then  the  desired  force  could  be  exactly  produced 
instantaneously  for  the  ideal  servo  system.  Of  course,  real  servo  systems  introduce  time 
lags,  non-linearities  and  modeling  errors,  which  introduce  additional  force  errors.  Because 
most  servo  systems  include  an  integrator  in  the  loop,  the  force  errors  could  be  eliminated 
over  time  even  if  the  system  flexibility  was  not  exactly  modeled. 

There  are  two  major  disadvantages  of  this  method  of  pure  force  control,  an  accurate 
stiffness  model  of  the  robot  should  be  developed  for  improved  performance  and  the  band- 
width of  this  system  is  limited  to  the  bandwidth  of  the  robot  servos.  For  some  applications, 
the  response  of  the  robot  will  be  too  sluggish  and  the  force  errors  may  reach  unacceptable 
levels.  As  mentioned  in  the  introduction  of  this  chapter,  external  force  control  is  certainly 
being  considered  and  tested  at  this  time. 

Recently,  several  researchers  have  attempted  to  use  this  method  offeree  control  for  sev- 
eral applications  including:  deburring,  brushing,  grinding,  dispersion  of  film  adhesives  and 
inspection  [38,39,40,41,42].  In  one  particular  application,  force  control  was  implemented 
on  a  General  Electric  P50  5-DOF  robot  to  provide  a  controlled  force  in  any  direction  of 
x,y  plane  of  the  robot  for  automated  deburring.  Several  limitations  were  encountered  in 
this  application  including:  the  robot  position  loop  bandpass  is  tuned  to  approximately 
3  Hz  for  the  base,  shoulder  and  elbow  joints.  Additional  time  delays  in  the  communica- 
tion between  the  core  controller  and  the  robot  controller  added  additional  delays  to  the 
system,  reducing  the  bandwidth  response  to  1.5  hz  [39]. 

Because  of  the  limitations  mentioned  above,  the  article  concludes  that: 
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The  major  factor  limiting  performance  is  reduced  bandpass  of  the  force 
control  when  the  robot  is  used  to  apply  force  through  tool  and  robot  arm 
complia,nce._....  With  the  advent  of  faster  computers  and  higher  performance 
servos,  it  will  be  possible  to  integrate  force  control  into  an  overall  robot  posi- 
tion control  with  the  bandpass  required  for  deburring  and  grinding In  the 

interim,  to  obtain  the  active  force  control  bandpass  required  for  deburring,  it 
is  recommended  that  one  or  two  high  performance  motion  axis  be  added  to  the 
robot  end  effector.  A  high  performance,  2  DOF  motion  control  would  provide 
a  10  hz  bandpass  with  limited  motion  needed  for  high  speed  grinding.  The 
robot  would  position  the  high  speed  end-effector  close  to  the  workpiece  edge 
and  also  move  the  tool  along  the  path.  [39]  pp.  73-78. 

Thus,  it  was  apparent  that  external  compensation  is  required  for  proper  force  control 
during  robotic  deburring  in  this  example. 

Similar  results  were  recorded  by  other  researchers,  where  the  robot  was  used  to  provide 
the  necessary  positioning  for  force  control.  Errors  in  the  force  could  be  partially  attributed 
to  the  low  bandwidth  of  the  robot  servos. 

In  addition  to  the  limited  band  width,  another  universal  problem  which  hindered  these 
applications  was  the  communications  problems  encountered  between  the  force  controller 
and  the  robot  controller.  Many  robot  manufacturers  have  either  neglected  external  robot 
controller  communications  completely,  provided  them  at  additional  cost  or  have  made 
them  difficult  to  implement  in  real  time.  This  greatly  limits  the  ability  of  an  internal  force 
control  strategy.  In  the  next  section,  the  operation  of  a  single  degree-of-freedom  external 
force  compensator  will  be  discussed. 

External  Force  Compensator  Description 

This  section  will  describe  a  single  degree-of-freedom  force  compensator  based  on  the 
single  degree-of-freedom  position  compensator  described  previously.  The  advantages  of 
this  method,  the  control  architecture  and  various  potential  applications  will  be  presented. 
It  should  also  be  pointed  out  that  this  method  of  external  force  compensation  could  be 
expanded  to  more  than  a  single  degree-of-freedom. 

The  force  for  a  positioning  device  is  directly  related  to  applicable  flexibilities  of  the 
system.  For  the  simple  example  given  in  Equation  3.12  knowing  the  stiffness  of  the  system, 
k,  the  displacement  required  to  produce  a  desired  force  is  easily  calculated.  For  structures 
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Figure  3.16:  Linear  Dynamic  Model  of  Robot  and  Compliant  Device 

such  as  robots,  however,  obtaining  the  stiffness  model  is  not  a  trivial  matter.  And  because 
the  robot  is  a  dynamic  structure,  the  stiffness  model  changes  as  the  robot  changes  position. 

To  implement  a  force  control  architecture,  the  stiffness  (or  flexibility)  model  could  be 
implemented  on  a  dedicated  controller  external  the  robot  controller.  This  would  require 
a  data  link  between  the  two  controllers  so  the  robot  position  could  be  monitored  by  the 
external  controller.  The  stiffness  matrix  for  the  robot  position  would  then  be  calculated 
or  retrieved  from  memory.  If  the  communication  capabilities  of  the  robot  controller  did 
not  allow  the  position  of  the  robot  to  be  transferer  to  the  dedicated  controller  in  real  time, 
this  method  of  force  control  would  be  unsuccessful.  At  this  point,  one  probably  realizes 
the  similarities  between  force  control  and  deflection  compensation  of  the  robot  structure. 

A  possible  alternative  to  accurately  modeling  the  robot  flexibilities  would  be  to  intro- 
duce additional  flexibilities  to  the  system  which  are  more  flexible  than  the  robot  structure. 
For  the  simple  linear  system  depicted  in  Figure  3.16,  the  stiffness  of  the  workpiece,  K^p 
will  be  assumed  to  be  much  greater  than  the  stiffness  of  the  robot,  K,..  In  essence,  the 
workpiece  stiffness  may  be  considered  infinite  as  compared  to  the  robot  flexibility.  This 
assumption  is  accurate  if  a  non-compliant  workpiece  is  properly  clamped  to  a  rigid  fixture. 
The  additional  flexibility  added  to  the  structure,  li'a  would  then  be  made  more  flexible 
than  that  of  the  robot  and  would  have  the  greatest  influence  on  overall  flexibility  of  the 
system. 

For  the  linear  system  found  in  Figure  3.16,  the  overaU  stiffness  for  the  springs  in  series, 
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Ko  can  be  easily  found  using  the  following  equation: 

1 


J/-   


4-  _!^  J J_ 

I       ft"       T^     K 


(3.17) 


which  simplifies  to: 


KrKa  +  KaKwp  +  KwpKr  ' 

Now  the  following  assumptions  are  made:  AV  =  lOA'^p  and  K^  -  10 AV-  Substituting 
into  the  above  equation,  the  resulting  overall  system  stiffness  is  found  in  the  following 

equation: 

100  ,, 
A„  =  — lu  (3.19) 

and  Ko  is  found  to  be  approximately  equal  to  Ka-  The  external  compliance  added  to  the 
system  becomes  dominant  when  it  is  more  flexible  than  the  robot  structure.  This  would 
eliminate  the  need  of  accurately  modeling  the  robot  flexibilities  and  providing  commu- 
nications between  the  robot  and  force  controller.  However,  this  does  lower  the  natural 
frequency  of  the  system  by  the  square  root  of  the  ratio  of  additional  flexibilities  to  the 
original  flexibilities  of  the  robot.  This  may  introduce  additional  stability  problems  to  the 
control  of  the  external  compensator  [43,44].  Several  researchers  have  added  compliant  de- 
vices to  the  end  of  arm  tooling  to  introduce  additional  flexibility  to  the  system.  Typically, 
Remote  Center  Compliance  (RCC)  devices  are  used  for  this  purpose. 

Most  RCC's  utilize  a  set  of  elastimetric  shear  pads,  which  make  the  device  stiff  in 
compression  and  relatively  soft  in  shear.  These  devices  were  originally  designed  for  assem- 
bly applications  where  contact  forces  due  to  misalig-nment-alignment  could  be  reduced. 
As  an  example  of  a  particular  device,  the  manufacturer  [45]  lists  the  following  following 
specifications: 

•  lateral  stiffness  -  42.0  N/mm  (241  lb/in) 

•  rotational  stiffness  -  230  N-mm/mrad  (2030  in-lb/rad) 

•  axial  stiffness  -  1800  N/mm  (10720  lb/in) 

•  torsional  stiffness  -  25.0  N-mm/mrad  (221  in-lb/rad) 
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The  lateral  stiffness  of  the  RCC  is  approximately  ten  times  more  flexible  than  that 
of  the  Cincinnati  Milacron  T3-776  robot  for  out-of-plane  motion.  Thus,  for  most  robot 
positions  the  dominant  flexibilities  of  the  system  would  be  due  to  the  RCC.  The  flexibility 
of  the  RCC  could  be  easily  modeled  and  used  in  the  force  control  algorithm. 

Internal  force  control  of  robots  utilize  compliant  devices  for  an  additional  reason,  the 
resolution  of  the  robot  is  too  coarse  for  the  small  incremental  changes  in  force  required  in 
some  applications.  For  the  GE  P50,  the  robot  has  a  resolution  of  0.005  inch  (.127  mm) 
in  each  axis  and  a  stiffness  of  50  lb/in  (8670  N/m),  which  results  in  an  incremental  force 
command  of  0.25  to  0.40  lb  (1.12  to  1.78  N).  It  is  felt  that  the  resolution  stated  by  Haefner 
[39]  is  somewhat  optimistic,  which  would  reduce  the  force  resolution.  The  RCC  reduces 
the  stiffness  by  a  factor  of  5,  which  provides  an  the  incremental  force  command  of  0.07  lb 
(0.31  N). 

With  an  externally  servoed  device,  the  resolution  (force  or  position)  at  the  end  effector 
may  be  increased  by  one  to  two  orders  of  magnitude  over  the  typical  resolution  of  the  robot 
end  effector.  For  example,  the  external  positioning  device  developed  for  the  position 
compensation  of  the  robot  described  earlier,  a  resolution  of  0.0001  inch  (0.0025  mm) 
was  theoretically  possible,  with  a  more  realistic  capability  of  0.0005  inch  (0.013  mm). 
Thus,  a  compliant  end  effector  with  a  flexibility  of  50  lb/in  and  a  positioning  device  with 
0.0005  inch  (0.013  mm)  resolution  located  at  the  end  effector,  the  force  resolution  could 
be  improved  to  0.025  lb  (0.11  N),  an  increase  of  one  order  of  magnitude  over  the  original 
GE  P50  robot  system  described  above. 

In  a  combined  package,  Instrumented  Remote  Center  of  Compliance  devices  (IRCC) 
provide  both  passive  compliance  needed  for  improved  force  control  and  active  sensing 
which  could  eliminate  the  need  of  having  a  wrist  mounted  force  sensor.  Typically  IRCC 
are  used  for  assembly  operations,  but  would  be  useful  for  force  control  applications  with 
relatively  low  force  requirements.  The  IRCC  devices  have  been  used  for  adaptive  control 
in  real  time  continuous  servo  loop  systems  as  a  feedback  element.  The  compliance  of  the 
IRCC  tends  to  increase  the  loop  stabihty,  permitting  higher  feedback  gains  [46]. 


Mounting 
Tool 
Plate     BL 


(1)  (2) 


Spr  ings 


\ \ 


(1)    Top   Plate 


(2)    Bottom 
Plate 

Y  Displaosment 
Probe 


X    DispUceflQnt 
Probe 


104 


Figure  3.17:  Two  Degree- Of- Freedom  Instrumented  Compliant  Device 

For  typical  metal  removal  operations,  the  resulting  forces  are  resolved  into  two  direc- 
tions, normal  to  the  cut  and  tangential  to  the  cut.  A  two  degree-of- freedom  force  sensor 
with  adjustable  compliance  could  be  used  instead  of  the  four  to  six  degrees-of-freedom 
of  typical  IRCCs  proposed.  The  orientation  of  the  two  degrees-of-freedom  of  the  force 
sensor  would  be  aligned  parallel  to  normal  and  tangential  forces  produced  by  the  cutting 
operation.  Thus,  the  unnecessary  complexity  and  poor  reliability  of  complex  six  degree- 
of-freedom  force  measuring  devices  would  be  eliminated.  This  two  degree-of- freedom, 
compliant  force  measuring  device  would  be  used  in  conjunction  with  a  high  resolution 
active  end-effector  with  one  or  two  servo  driven  axes. 

The  high  resolution  positioning  device  could  be  located  between  the  wrist  flange  of  the 
robot  and  the  instrumented  compliant  device.  A  two  degree-of-freedom  compliant  device 
was  designed  using  two  orthogonal  sets  of  leaf  springs.  This  design  retains  high  stiffness 
in  the  remaining  four  degrees-of-freedom.  By  varying  the  length,  width  or  thickness  of 
the  springs,  the  flexibility  coefficients  could  be  easily  changed.  Figure  3.17  depicts  the 
basic  design  of  the  device.  Two  orthogonally  mounted  displacements  devices  would  be 
used  to  measure  the  displacement  of  the  tool  mounting  plate  relative  to  the  bottom  plate, 
which  is  mounted  to  the  wrist  flange  of  the  robot.  Sensitivity  of  a  typical  displacement 
transducer  is  0.0001  inch  (2.5  um)  in  translation,  with  a  range  of  -f /-  0.1  in  (2.5  mm).  If 
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a  spring  with  240  lb/in  (40  N/mm)  were  used,  the  force  resolution  of  the  device  would  be 
0.024  lb  (0.01  N).  This  would  provide  a  flexibility  of  approximately  10  times  the  maximum 
flexibility  of  the  robot.  This  would  make  the  flexibility  of  the  compliant  device  dominant, 
thus  eliminating  the  need  of  modeling  the  robot  flexibilities.  However,  the  device  would 
be  limited  to  externally  applied  forces  of  24  lb  (107  N),  adequate  for  the  forces  produced 
during  edge  milUng,  light  grinding  or  deburring. 

This  device  has  several  advantages  over  other  commercially  available  IRCC's,  the  com- 
pliance or  flexibility  can  be  easily  varied  by  changing  the  length,  width  or  thickness  of  the 
springs,  the  displacements  and  forces  are  uncoupled  in  the  two  directions  of  measurement, 
the  device  would  be  inexpensive  to  manufacture  and  the  analog  output  of  the  transducer 
allows  true  real  time  operation  without  any  additional  digital  components. 

This  system  incorporating  the  resolution  positioning  device  and  IRCC,  could  be  com- 
pletely self-contained  and  adaptable  to  a  wide  variety  of  industrial  robots.  Highly  resolved 
force  control  would  be  available  without  any  previous  knowledge  of  the  robot  character- 
istics, including:  structural  deformation  information,  control  architecture,  and  software 
capabilities. 

Continued  Work  In  External  Compensation 

Recently,  the  need  for  a  multiple  degree-of-freedom  active  compensator  became  appar- 
ent for  more  complicated  tasks,  including  insertion  tasks.  For  the  square  peg-in-the-hole 
insertion  task,  there  are  five  force  constraints  and  a  single  degree-of-freedom  in  position, 
ie.  in  and  out  of  the  hole.  Thus  for  this  task,  a  five  degree-of-freedom  active  device  was 
considered. 

Some  general  considerations  of  this  device  included  the  ability  to  provide  passive  com- 
pliance (have  some  specified  structural  flexibility),  internal  force  measuring  ability,  com- 
pact design  and  high  bandwidth.  This  device  would  utilize  a  dedicated  controller  based 
on  an  in-expensive  PC  device.  Prior  to  the  mating  operation,  the  end-effector  would  be 
under  position  control.   After  the  mating  is  completed,  the  system  would  be  under  pure 
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Figure  3.18:  Five  Degree-Of-Freedom  Active  Compensator 

force  control.  During  the  actual  mating  operation,  the  compensator  would  utilize  both 
position  and  force  information.  This  period  of  combined  force/position  operation  will  be 
discussed  in  detail  shortly. 

The  kinematic  design  for  this  device  is  quite  unique.  It  involves  a  parallel  kinematic 
structure  consisting  of  five  prismatic  links  which  are  servo  controlled.  Figure  3.18  shows  the 
basic  design  of  the  structure.  An  orthogonal  pair  of  parallelograms  will  be  used  to  provide 
almost  completely  uncoupled  motion  of  the  output  plate,  in  Cartesian  coordinates.  This 
mechanism  provides  a  limited  range  of  motion  in  all  directions  except  rotations  about 
the  Z  axis.  The  Stewart  Platform  is  a  similar  device  where  it  uses  parallel,  prismatic 
links  and  provides  a  limited  motion  in  six  degrees-of- freedom.    However,  motions  of  the 
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Figure  3.19:     Schematic  Representation  of  the   Prismatic  Linkages   For  the   Five   De- 
gree-Of-Freedom  Compensator 


Stewart  Platform  use  highly  coupled,  coordinated  motion  between  the  links,  requiring 
time  consuming  transformations  for  the  desired  motion  of  the  output  plate.  Additionally, 
one  or  more  of  the  active  links  of  the  five  degree-of-freedom  device  could  be  replaced  with 
passive  links  to  provide  a  highbred  active/passive  compensator. 

Figure  3.19  shows  the  schematic  representation  of  the  active  prismatic  link.  It  incor- 
porates a  lead-nut  screw  to  convert  the  rotary  motion  of  the  servo  to  the  desired  linear 
motion  of  the  prismatic  link.  In  addition  to  the  active  positioning  of  the  lead-nut  screw,  a 
spring  is  also  included  in  series  to  provide  passive  compliance.  By  knowing  the  stiffness  of 
the  spring,  and  measuring  its  deflection,  the  force  applied  at  that  link  would  be  accurately 
known.  This  would  provide  high  resolution  force  control,  an  internal  force  measuring 
system  and  improved  system  stability.  This  setup  is  described  as  a  hybrid  compliance 
(both  active  and  passive)  device.  The  spring  could  be  replaced  with  a  rigid  link  to  provide 
strictly  active  compensation.  The  lead-nut  screw  could  be  fixed  so  that  the  link  provides 
only  passive  compliance.  Additionally,  the  hybrid  link  could  be  completely  replaced  by  a 
rigid  link  for  other  applications. 

As  mentioned  previously,  prior  to  the  the  actual  insertion,  the  active  compensator 
will  be  position  controlled,  using  position  information  provided  by  external  means,  ie.  a 
real  time,  target  tracking  vision  system.  After  the  insertion  is  completed,  the  system  is 
completely  force  controlled.  The  control  scheme  for  this  external  device  would  be  very 
similar  to  the  control  diagram  seen  in  Figure  3.15.  Remember  that  during  force  control. 
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Figure  3.20:  Transition  Between  Position  and  Force  Control 

the  force  gain  matrix,  Gi  is  the  identity  matrix  and  the  position  gain  matrix,  G2  is  zero, 
and  the  opposite  is  true  for  position  control.  But  what  happens  during  the  transition 
period  between  position  and  force  control?  Figure  3.20  illustrates  this  transition  period. 
This  area  of  research  is  currently  under  investigation  by  the  author  through  simulation. 
A  single  degree-of-freedom  servo  mechanism  will  be  used  to  demonstrate  the  resulting 
control  scheme. 

External  active  compensation  provides  many  advantages  over  traditional  compensation 
techniques.  This  device,  if  it  lives  up  to  its  expectations  will  provide:  position  or  force 
compensation,  fast  response,  high  resolution  internal  sensing,  and  both  passive  and  active 
compliance  for  multiple  degrees-of-freedom. 


CHAPTER  4 
FLEXIBILITY  COMPENSATION 


In  this  section,  a  brief  literary  review  of  flexibility  modeling  and  compensation  tech- 
niques will  be  presented.  Then  the  task  of  actually  compensating  for  the  deflections  due 
to  applied  loads  will  be  discussed.  The  compensation  task  is  divided  into  four  sections: 

1.  Identifying  the  flexible  elements  in  the  robot  structure  and  quantifying  their  flexi- 
bilities. 

2.  Formulating  the  resulting  flexibilities  at  the  tool  as  a  function  of  position  of  the  tool 
in  the  workspace  of  the  robot. 

3.  Measuring  the  cutting  force  and  calculating  the  deflections  at  the  tool. 

4.  Generating  commands  for  a  corrective  motion  at  the  compensator. 

The  first  two  tasks  were  accomplished  by  Stern  [8]  and  they  will  be  discussed  to  provide 
a  complete  overview  to  the  compensation  technique.  The  second  two  tasks  were  performed 
during  the  course  of  this  research  and  will  also  be  discussed.  Finally,  results  of  both  static 
and  dynamic  tests  will  be  presented. 

Flexibility  Modeling  and  Compensation  Review 

In  many  robotic  applications,  significant  external  loads  are  present  which  may  produce 
errors  in  position  and  orientation  at  the  end  effector.  In  general,  as  the  precision,  load, 
or  load  variation  increases,  the  value  of  the  robot  application  also  increases.  This  is 
because  skilled  workers  are  often  replaced  in  these  applications  which  include  the  following 
manufacturing  areas:  assembling,  drilling,  routing,  polishing,  deburring,  polishing  and 
edge  milhng. 

Typical  robot  arms  exhibit  a  high  degree  of  flexibility  outside  of  their  positional  control 
loop.   Thus  large  deformations  occur,  resulting  in  reduced  precision  when  external  loads 
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are  present.  These  errors  due  to  applied  loads  are  typically  greater  than  the  errors  due  to 
geometric  accuracy  errors.  Full  rated  loads  may  cause  deformations  of  10  to  20  times  the 
stated  repeatability  of  the  system,  Sklar  [9].  Obviously,  to  achieve  the  required  precision 
while  externally  applied  loads  are  present,  these  deformations  must  be  compensated  for. 
There  are  currently  three  general  techniques  which  can  be  employed  to  eliminate  the 
deformation  errors.  The  first  method  involves  using  the  familiar  but  expensive  rigid  tem- 
plate technique,  which  was  described  in  the  introduction.  The  second  technique  incorpo- 
rates various  sensors  which  directly  or  indirectly  measure  the  displacement  error  caused 
by  the  robot  deflections.  For  example,  a  vision  system  could  directly  track  the  desired 
path  which  was  inscribed  on  the  workpiece.  Deviations  from  the  desired  path  would  result 
in  error  commands,  which  drive  the  deflection  compensator. 

The  third  technique  used  to  detect  deformation  errors  involves  modeling  the  flexibilities 
of  the  manipulator  and  predicting  the  deflection  errors.  For  some  applications,  where  the 
external  loads  are  known  in  advance,  the  displacement  error  can  be  predicted  and  a  feed 
forward  compensation  technique  can  be  used.  In  other  cases,  where  the  applied  loads 
are  not  known,  the  external  forces  must  be  measured  in  real  time  and  using  the  flexibility 
model,  the  deflections  would  again  be  estimated  and  compensated  for  in  a  feedback  control 
method. 

The  primary  advantages  of  using  this  third  method  are:  it  is  a  simple  and  less  expensive 
system,  it  has  the  ability  to  predict  ahead  of  time  the  deflections  due  to  known  loads  and 
this  system  could  be  easily  moved  to  robots  of  the  same  type. 

Several  methods  of  modeling  robot  structures  are  currently  being  employed  including: 
finite  element  analysis  of  structures,  and  physical  modeling  of  actual  robots,  using  both 
static  modeling  methods  and  dynamic  modeling  methods.  In  most  cases,  the  flexibility 
of  the  robot  manipulator  is  represented  by  a  compliance  or  flexibility  matrix  relating  the 
6  components  of  force  to  6  components  of  deflection.  And  because  the  flexibilities  of 
the  manipulator  change  as  the  robot  changes  position,  the  flexibility  matrix  is  position 
dependant. 
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Research  in  the  area  of  dynamic  analysis  of  planar  mechanisms,  and  the  extension  to 
spatial  mechanisms  has  been  a  popular  topic  for  quite  some  time.  Unfortunately,  little 
effort  has  been  placed  on  the  actual  identification  of  flexibility  parameters  needed  for 
deflection  compensation  of  real  on-line  robots.  The  majority  of  the  work  is  focused  on  the 
form  of  the  models  and  dynamic  analysis  formulations. 

Because  much  of  the  past  research  on  the  dynamic  analysis  of  flexible  mechanisms  is 
helpful  for  model  identification,  a  brief  review  will  be  provided  here.  Research  in  the  area 
of  flexible  systems  began  with  simple  planar  mechanisms.  Winfrey  [47]  has  developed  a 
complete  vibrational  analysis  and  dynamic  model  of  linkages  composed  entirely  of  elastic 
links.  This  technique  has  been  simplified  by  Erdman  and  Sandor  [48]  in  a  technique 
identified  as  "Kineto-Elastatic  Analysis".  This  is  a  quasi-static  approach  where  the  inertial 
loads,  in  a  planar  linkage,  are  considered  as  applied  loads  acting  on  a  fixed  structure. 
Dubowsky  and  Gardner  [49]  have  developed  a  similar  model  but  include  non-linear  effects 
such  as  joint  backlash. 

The  dynamic  analysis  for  both  spatial  mechanisms  and  manipulators  has  been  con- 
sidered in  the  literature.  Book  [50]  was  one  of  the  first  researchers  to  provide  a  clear 
dynamic  model  of  an  open  link  chain  containing  flexible  links.  A  complete  vibrational 
model,  considering  loads  applied  at  the  end-effector  only,  was  presented.  This  work  iden- 
tified distinct  deflection  coordinates  for  each  link,  essential  for  identifying  individual  joint 
flexibilities  from  global  flexibilities.  Huston  and  Kelly  [51]  have  extended  this  technique 
through  the  use  of  the  D'Alembert  force  principal  to  include  the  inertial  load  effects  acting 
on  each  link. 

Dubowsky  and  Sunada  [52]  developed  an  extensive  formulation  which  actually  pre- 
dicts the  flexibility  parameters  based  on  finite  element  methods.  Other  researchers  have 
also  considered  this  approach.  Thompson  and  Sung  [53]  developed  a  finite  element  for 
planar  linkages  which  includes  non-linear  modeling  of  the  link  deformations.  However,  for 
actual  industrial  robot  systems,  this  becomes  extremely  difficult  because  the  links  are  not 
composed  of  simple  'laboratory'  link  geometries.   Additionally,  the  computational  effort 
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becomes  overwhelming. 

Recently,  two  researchers  actually  modeled  identical  robots,  two  Cincinnati  Milacron 
T3-776  robots,  using  two  dissimilar  techniques.  First,  Sklar  [9]  used  static  measurements 
to  identify  both  the  global  flexibilities  (at  the  end-effector)  of  the  robot  and  the  local 
flexibilities  at  each  link.  This  was  done  by  making  static  measurements  of  the  robot 
in  a  variety  of  positions  and  curve  fitting  the  data  to  provide  the  necessary  flexibility 
parameters.  Second,  Stern  [8]  used  dynamic  methods  to  model  the  robot.  By  applying 
impulses  to  the  structure  and  measuring  the  dynamic  response,  the  spring-mass  model 
of  the  robot  was  established.  The  respective  local  flexibilities  were  within  20  percent  of 
each  other  for  the  two  studies.  With  this  information,  both  local  and  global  flexibilities 
were  developed.  The  results  of  the  dynamic  modeling  method  were  used  in  this  flexibility 
compensation  and  the  model  will  be  explained  in  the  next  section. 

Not  only  are  the  determination  of  flexibility  parameters  ignored  by  many  researchers,  so 
is  the  compensation  for  eliminating  deformations  at  the  end-effector.  Bagci  [54]  developed 
a  quasi-static  model  which  uses  an  iterative  compensation  algorithm  providing  joint  angle 
corrections  to  compensate  for  end-effector  deformations.  Using  the  system  joint  actuators 
for  the  required  compensation  limits  the  response  time  to  the  inherent  capabilities  of 
the  robot.  Thus  a  few  researchers  have  considered  active  high  speed  external  devices 
with  higher  bandwidths  to  provide  the  necessary  compensation.  Zalucky  and  Hardt  [55] 
have  developed  a  specialized  robot  link  mechanism  which  actually  determines  the  local 
deflection  of  a  specific  link  in  the  robot  and  compensates  for  the  deflection  using  a  servo- 
driven  actuator  within  the  link  mechanism.  Thus  local  deflections  (deflections  occurring 
at  the  individual  links)  are  compensated  for  directly. 

Other  researchers  have  developed  compensators  at  the  end  of  the  manipulator,  provid- 
ing active  end-effectors.  These  include  the  single  degree-of-freedom  device  developed  for 
edge  milling  by  Tlusty  and  Wegerif  [32]  and  the  two  degree-of-freedom  device  by  Tilley, 
Cannon  and  Kraft  [26]  for  force  control.  The  two  degree-of-freedom  device  used  a  five-bar 
mechanism  at  the  end  of  a  flexible,  single  degree-of-freedom  manipulator.  This  device  was 
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developed  to  provide  force  control  at  the  end-effector,  but  it  may  also  be  used  to  provide 
positional  compensation  as  well. 

Various  applications  requiring  some  type  of  flexibility  compensation  include  the  control 
of  very  flexible  manipulators.  Typical  applications  for  these  devices  include  underwater 
and  zero  gravity  environments.  Recently,  much  research  has  been  devoted  to  the  control 
of  these  flexible  manipulators,  which  are  really  a  special  and  limited  type  of  manipulator. 
The  models  of  these  flexible  manipulators  have  structural  frequencies  of  approximately 
1  Hz,  as  compared  to  typical  industrial  robots  where  the  lowest  structural  frequency  is 
approximately  10  Hz.  Thus,  the  standard  industrial  robot  is  approximately  100  times  as 
stiff  as  the  flexible  manipulator.  With  these  great  flexibilities  encountered  in  the  flexible 
manipulator,  it  is  obvious  that  some  type  of  compensation  is  required  to  provide  the 
necessary  accuracy  at  the  end-effector. 

Little  research  exists  in  the  positional  compensation  of  these  large  devices.  Tilley  and 
Cannon  [26]  demonstrated  the  great  advantage  in  using  an  active  compensator  to  provide 
accurate  force  control  of  a  flexible  mechanism,  and  it  is  apparent  that  similar  techniques 
could  be  imposed  to  provide  accurate  position  control  as  well. 

Active  compensation  at  the  end-effector  has  been  expanded  to  provide  a  complete  6 
degree-of-freedom  "micro-manipulator"  device  capable  of  providing  complete  compensa- 
tion for  end-effector  deformations  [31].  Compensation  achieved  through  external  devices 
offers  several  signiflcant  advantages  over  compensation  by  robot  joints: 

•  The  active  compensator  can  be  designed  to  have  a  higher  bandwidth  than  the  robot 
actuators. 

•  The  active  compensator  can  be  designed  to  have  better  resolution  than  that  of  the 
robot. 

•  An  active  end-effector  is  a  stand  alone  device  and  could  be  attached  to  any  robot, 
given  the  input  control. 
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Dynamic  Modeling  of  T3-776  Robot 

In  this  section,  a  synopsis  of  the  dynamic  modeling  done  by  Stern  [8]  will  be  presented. 
By  providing  a  dynamic  model  of  the  robot,  the  flexibility  matrix  of  the  robot  could  be 
extracted  and  be  used  to  provide  compensation  due  to  deflections  of  the  robot  structure. 

The  dynamic  measurements  of  the  robot  were  arranged  to  obtain  a  dynamic  model  of 
the  structure  as  an  assembly  of  springs,  masses  and  dampers  as  they  respond  to  external 
forces.  Modal  analysis  techniques  were  used  to  derive  this  dynamic  model  of  the  robot. 
Modal  analysis  describes  the  sum  of  motions  of  a  linearly  elastic  system  which  exhibits  a 
characteristic  pattern  or  shape  of  deformation.  The  amplitude  of  the  oscillatory  motion  of 
each  vibrational  mode  is  defined  by  a  unique  set  of  parameters:  mass,  stiffness,  damping 
and  time  varying  forces  which  induce  the  motion. 

For  each  mode  of  vibration,  the  amplitudes  of  the  motion  for  each  point  in  the  structure 
can  be  expressed  relative  to  a  single  point.  This  relationship  of  the  relative  amplitudes 
of  motion  for  each  point  in  the  structure  is  known  as  a  mode  shape.  The  mode  shape 
describes  the  shape  of  the  characteristic  deformation  pattern  exhibited  by  each  mode  of 
vibration  [8]. 

The  motion  of  an  n  degree-of-freedom  system  is  described  by  a  set  of  n  ordinary 
differential  equations  of  the  second  order,  where  n  describes  the  number  of  vibrational 
modes  of  the  structure.  .For  the  simple  undamped  case,  the  equations  of  motion  can  be 
written  as: 

[M]{x}  +  [K]{x}  =  {F}  (4.1) 

where 

[M]  -  mass  matrix 

[K]  -  stiffness  matrix 

{x}  -  acceleration  in  local  coordinates 

{x}  -  displacement  in  local  coordinates 

{F}  -  applied  force  in  local  coordinates 


imtm^r^,i<^i*,-i,tn*]a^s-.mi*^'i 
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The  harmonic  equation  of  motion  during  free  vibration  is  represented  as: 

-u'[M]{x}  +  [K]{x}  =  {0}  (4.2) 

The  non-trivial  solution  to  the  above  equation  is  known  as  the  eigenvalue  problem  and 
can  only  be  solved  if  the  characteristic  determinant 

|[/i']-u;^[M]|  =  0  (4.3) 

vanishes.  The  characteristic  equation  is  obtained  by  expanding  the  determinant  to  form 
an  n  order  algebraic  expression  in  u"^,  where  the  n  roots  (eigenvalues)  are  denoted 
Ui,U2,  ...ji^n-  The  positive  square  roots  of  tlie  eigenvalues  correspond  to  the  undamped 
natural  frequency  of  the  system  [8]. 

For  each  natural  frequency  w,-,  a  non-trivial  vector  solution  of  equation  4.2  yields  an 
eigenvector  pi  corresponding  to  each  mode  of  vibration.  Each  of  these  vectors  is  called 
a  modal  vector  or  mode  shape.  Normalizing  these  n  mode  shapes  to  a  given  reference 
and  assembling  them  into  a  square  matrix  results  in  the  formation  of  the  modal  matrix 
[P].  By  pre-  and  post-multiplying  the  mass  matrix  [M]  by  the  modal  matrix,  the  diagonal 
modal  mass  matrix  [Mq]  is  produced.  In  a  similar  fashion,  the  modal  stiffness  matrix  [Kg] 
is  produced.  The  excitation  forces  {F}  are  transformed  to  modal  coordinated  {R}  also. 

[Mq]  =  [P]^[M][P]  (4.4) 

[iQ  =  [pfmip]  (4.5) 

{R}  =  {Ff[P]  (4.6) 

Thus  equation  4.2  can  be  rewritten  as: 

{-u'[Mq]  +  [lQ){q}  =  {R}  (4.7) 


Solving  for  the  vibration  in  any  one  of  the  modal  coordinates  qi: 

Ti 

ki  -  ufrrii 
where 


(4.8) 
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r,-  -  force  applied  to  the  i^^  modal  coordinate 

ki  -  i^^  element  on  the  diagonal  of  [Kg]  corresponding  to  the  modal  stiffness  of  the  i^'^ 
mode  of  vibration 

rrii  -  i^^  element  on  the  diagonal  of  [Mq]  corresponding  to  the  modal  mass  of  the  i*'*  mode 
of  vibration 

Ui  -  the  natural  frequency  of  the  i     mode  of  vibration 

The  vibration  of  the  system  can  be  regarded  as  the  superposition,  or  linear  sum,  of 
the  n  nodes  of  vibration:  ■♦ 

n 

W^E^'fe}  (4-9) 

t"=i 

These  equations  can  be  further  expanded  to  include  both  proportionally  damped  and 
unproportionally  damped  vibration.  This  is  fully  explained  in  [8]. 

The  dynamic  measurements  of  the  robot  structure  were  done  in  three  groups: 

1.  Measurements  in  the  X-Z  plane  of  the  structure  or  in-the-plane  motions,  not  includ- 
ing the  wrist. 

2.  Measurements  in  the  Y  direction,  perpendicular  to  the  X-Z  plane  or  out-of-plane 
motions,  not  including  the  wrist. 

3.  Measurements  of  the  wrist  for  motions  in  X,Y  and  Z  directions. 

Figure  4.1  shows  the  T3-776  robot  in  the  X-Z  plane  and  the  various  point  of  mea- 
surements. These  points  were  used  to  develop  the  modal  model  or  dynamic  model  of  the 
robot.  The  direct  transfer  function  was  obtained  by  applying  an  impulse  force  in  the  Z 
direction  at  coordinate  4.  The  direct  transfer  function  is  shown  in  Figure  4.2  Because 
the  modes  are  uncoupled,  they  can  be  treated  as  independent  and  the  equation  for  single 
degree-of-freedom  damped  system  can  be  used  to  provide  the  system  parameters.    The 
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Figure  4.1:  Drawing  of  tlie  T3-776  Robot  and  the  Various  Points  of  Measurement  (Adapted 
from  [15]) 


in/sec 


Ibf 


Figure  4.2:  Direct  Transfer  Function  of  In  Plane  Motion  of  T.3-776  Robot  (Adapted  from 
[15]) 
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following  equation  is  the  generalized  form  of  a  single  degree-of- freedom  damped  system 
(spring,  mass,  dashpot): 

X  =  ^'^     (4.10) 

where 


X  -  the  magnitude  of  the  displacement  ra  -  the  mass  of  the  system 

F  -  the  applied  force  in  the  x  direction  k  -  the  spring  rate  of  the  system 

u  -  the  forcing  frequency  C,  -  the  damping  ratio  of  the  system 
Lj-n  -  the  systems  natural  frequency 


The  transfer  function  was  curve  fitted  using  a  modal  analyzer  and  the  parameters  for 
each  of  the  four  modes  are  listed  below. 

Modal  Parameters  Of  Direct  Transfer  Function 

Mode  f  (Hz)  k  (N/m)  m  (kg)  C  (%) 

1  10.09  0.97  *10^        241  1.38 

2  24.83  1.34  +10^        550  3.06 

3  34.24  1.05  *10^  22704  5.95 

4  40.64  3.57  +10^  54882  5.54 

The  GenRad  dynamic  analyzer  can  be  used  to  animate  the  various  modes  of  vibra- 
tion for  the  X-Z  plane  and  they  are  depicted  in  Figure  4.3.  These  modes  are  associated 
with  four  structural  degrees-of-freedom  and  they  have  led  to  a  planar  model  depicted  in 
Figure  4.4.  The  modal  parameters  must  be  converted  into  local  coordinates  to  be  use- 
ful, so  the  methods  of  transforming  modal  to  local  parameters  as  described  earlier  were 
invoked.  Four  concentrated  flexibilities  (springs)  were  located,  one  in  each  leadscrew  nut 
transmissions  {ki  and  k2)  and  the  others  in  the  foundation  of  the  robot  (Ajs  and  ^-4). 
Four  concentrated  masses  were  also  identified  and  they  are  labeled  mi  through  m^.  The 
following  table  provides  the  local  springs  and  masses  for  the  planar  system. 
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Figure  4.3:  Mode  Shapes  of  the  Basic  Structure  in  the  X-Z  Plane  (Adapted  from  [15]) 
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Figure  4.4:  Model  Corresponding  to  the  Modes  in  the  X-Z  Plane  (Adapted  from  [15]) 
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Figure  4.5:  Model  Showing  All  the  Local  Springs  and  Masses  (Adapted  from  [15]) 


Local  Stiffnesses  And  Masses 


k(N/m) 


m(kg) 


ki  =  5.56  *10^  mi  =  182 

k2  =  7.77  +10^  ms  =  94 

^3  =  3.49  +10^  ms  =  156 

k^  =  1.44  *10®  m4  =  2408 


The  location  and  magnitude  of  these  masses  and  springs  required  a  great  deal  of 
modeling  skills  and  trial  and  error  before  they  were  quite  accurate.  But  this  should  give 
a  basic  understanding  of  how  these  local  flexibility  parameters  were  derived. 

In  a  similar  fashion,  the  out  of  plane  dynamics  and  finally  the  wrist  dynamics  were 
measured  and  modeled.  A  model  showing  the  stiffnesses  of  the  local  springs,  and  local 
masses  is  presented  in  Figure  4.5.  The  torsional  springs  ks  and  kg  appear  in  the  out-of- 
plane  modes.  The  former  one  is  a  combination  of  bearing  deformations  in  the  mounting 
of  the  table  and  of  the  base  of  the  housing.  The  latter  one  is  due  to  the  flexibilities  of 
the  bearing  in  the  elbow  joint  axis.  The  springs  k-,  kg  and  kg  are  due  to  the  torsional 
flexibilities  of  the  wrist  torque  tubes  and  coincide  with  the  kinematic  freedoms  of  the 
wrist.  The  identified  values  of  the  springs  k^  through  kg  are: 
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Local  Stiffnesses  ^5  Through  kg 

Nm/rad 
ks  =  3.05  *10^     A;6  =  1.05  *10^ 
kv  =  6.90  tlO'*     ks  =  2.03  +10'* 
kg  =  1.37  +10^ 

In  summary,  the  modal  parameters  as  well  as  the  mode  shapes  are  determined  by 
comparing  the  direct  and  cross  transfer  functions  measured  at  various  locations  of  the 
structure.  Transfer  functions  are  made  by  exciting  the  structure  with  an  instrumented 
impact  hammer  and  measuring  the  response  of  the  structure  at  various  locations  producing 
both  direct  transfer  and  cross  transfer  functions.  With  the  modal  mass  and  stiffness  matrix 
known,  the  local  masses  and  stiffnesses  could  be  solved  for.  With  the  local  flexibilities 
known  to  within  5%,  the  global  flexibilities  could  then  be  calculated  for  any  given  robot 
position. 

Position  Dependant  Global  Flexibilities 

To  accurately  compensate  for  the  structural  flexibilities  of  the  robot,  the  modeled 
local  flexibilities  are  transformed  into  a  more  convenient  coordinate  system.  In  essence, 
flexibilities  of  both  the  structure  (base,  shoulder  and  elbow)  and  the  wrist  are  transformed 
to  wrist  coordinates.  The  forces  measured  at  the  end  effector  are  transformed  to  wrist 
coordinates  also.  The  transformed  flexibilities  are  multiplied  by  the  transformed  forces 
and  a  displacement  in  the  wrist  coordinates  are  produced.  Finally,  the  displacements  in 
the  wrist  coordinates  are  back  transformed  into  the  tool  coordinates,  and  the  displacement 
in  the  tool  coordinates  are  used  to  control  the  compensator.  Stern  [8]  has  detailed  this 
procedure  and  a  brief  synopsis  will  be  presented  here. 

The  geometric  configuration  of  the  robot  is  defined  by  the  position  and  orientation  of 
the  tool  in  space.  The  position  of  the  tool  is  expressed  in  global  Cartesian  coordinates 
X,  Y  and  Z.  The  origin  of  the  global  reference  frame  is  fixed  at  the  intersection  of  the 
first  and  second  joints  of  the  robot.  The  orientation  of  the  tool  is  referenced  to  the  global 
system  by  the  orientation  space  coordinates  D,  E  and  R  (yaw,  pitch  and  roll). 
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Figure  4.6:  The  Four  Coordinate  Systems  in  Robot  Model  (Adapted  from  [15]) 

Four  coordinate  systems  were  used  to  define  tire  configuration  of  tire  robot  structure,  as 
depicted  in  Figure  4.6.  As  mentioned  previously,  the  global  reference  frame  (g)  is  located 
at  the  intersection  of  the  first  two  joints.  The  wrist  coordinate  system  (w)  is  located  at  the 
center  of  the  three  revolute  wrist.  The  plate  coordinate  system  (p)  is  located  at  the  tool 
mounting  flange,  and  the  tool  coordinate  system  (t)  is  located  at  the  end  of  the  tool.  The 
plate  and  tool  coordinate  systems  have  the  same  orientation  with  a  fixed  translation.  The 
force  sensor  is  also  located  at  the  tool  mounting  flange  and  it  utilizes  the  plate  coordinate 
reference  frame. 

The  deflections  of  the  robot  are  divided  into  two  segments:  those  deflections  due  to 
the  robot  structure  and  those  deflections  due  to  wrist  deflections.  First,  the  deflections  of 
the  robot  structure  will  be  explained. 

The  location  of  the  tool  end  point  is  always  known  by  the  robot  controller  in  global 
coordinates  {T}g,  as  the  point  in  space  which  must  be  accurately  controlled.  There  is  a 
fixed  vector  between  the  tool  tip  and  the  wrist  center  and  this  is  known  in  tool  coordinates 
as  {DW}t.  By  transforming  the  vector  {DW}t  into  global  coordinates  {DW}g,  the  wrist 
center  can  be  specified.  The  transformation  is  found  in  the  following  equation: 


{DW}g  =  [RE][RD][RR]{DW}t 


(4.11) 
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Figure  4.7:  Location  of  Wrist  Center  in  Global  Coordinates 

Each  rotation  matrix,  [R*]  is  defined  by  the  tool  orientation  description:  yaw  (E),  pitch 
(D),  roll  (R).  Knowing  the  vector  {DW}g  and  the  tool  end  point  location  in  global  coor- 
dinates {T}g,  the  location  of  the  wrist  center  in  global  coordinates  {DW}g  can  be  found 
using  simple  vector  addition: 


{W},  -  {T}g  +  {DW}, 


(4.12) 


This  is  illustrated  in  Figure  4.7.  In  a  similar  manner,  the  global  position  of  the  tool 
mounting  plate  {P}g  may  also  be  determined.  Once  the  location  of  the  wrist  is  defined, 
the  geometry  is  solved  through  a  closed  form  solution.  The  locations  of  the  eleven  points 
used  to  define  the  robot  model  seen  in  Figure  4.1,  are  calculated.  The  flexibilities  of  the 
robot  structure  are  then  predicted  using  the  local  flexibility  models.  These  flexibilities  are 
expressed  in  the  wrist  coordinates  by: 


[FLEXU  =  [RF]- 


FlexX         0  0 

0         FlexY         0 
0  0  FlexY 


[RF]-' 


(4.1.3) 


where  [RF]  is  the  rotation  of  the  forearm  relative  to  the  X  axis  as  measured  about  the 
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Y  axis.  It  is  important  to  note  that  the  planar  flexibilities  of  the  robot  (Flex  X  and 
Flex  Y)  are  predicted  based  only  on  the  foundation  flexibilities  denoted  A'3  and  K4  in 
Figure  4.4.  The  flexibilities  of  shoulder  and  elbow  are  compensated  for  over  time  due  to 
position  feedback  mechanism  of  these  joints.  This  feedback  compensation  will  be  discussed 
in  detail  later. 

By  transforming  the  forces  measured  at  the  plate  {F}p  back  to  the  wrist  coordinate 
system,  the  displacement  of  the  structure  at  the  wrist  can  be  calculated.  The  following 
transformation  is  used  to  provide  the  forces  at  the  wrist: 

{F}^  =  [RF][RE][RD][RR]{F},{F}^  =  [Rpw]{F}p  (4.14) 

The  matrix  [Rpw]  provides  transfomiations  from  the  plate  to  wrist  coordinates.  The 
displacement  of  the  wrist  center  is  calculated  relative  to  the  wrist  coordinate  system  by 
the  following  equation: 

{dW:c}w  =  [FLEX]^{F}^  (4.15) 

Next,  the  flexibilities  of  the  wrist  are  calculated.  The  moments  about  the  axes  of 
the  wrist  coordinate  system  are  determined  by  the  vector  cross  product  of  {Rwp}^^;  (the 
displacement  between  the  plate  and  the  wrist  in  wrist  coordinates)  and  the  measured 
forces  represented  in  the  wrist  coordinates,  {F}^: 

{M,}  =  {Rwp}^  X  {F}^  (4.16) 

These  moments  are  then  transformed  by  the  matrix  [Ml]  into  moments  about  the  indi- 
vidual wrist  axes  by: 

{MR,}  =  [M1]{M^}  (4.17) 

The  moments  about  each  axis  in  the  wrist  is  denoted  {A4Ri}.  The  resulting  rotations 
(roll)  of  each  revolute  is  determined  by  the  identified  torsional  spring  rates  of  the  wrist 
model: 

{ROLL,}  =  i^^  (4.18) 
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The  rotation  about  the  wrist  axes  are  then  represented  as  equivalent  rotations  about  the 
wrist  coordinate  axes  by  the  following  transformation: 

{ROLL^}  =  [MT]{ROLLi}  (4.19) 

where  {ROLL^;}  denotes  the  rotations  about  the  wrist  coordinate  system.  The  displace- 
ment of  the  tool  relative  to  the  wrist  can  now  be  determined,  knowing  the  vector  between 
the  wrist  center  and  the  tool  end-point,  {Rwt}.  By  cross  multiplying  the  vectors  {ROLL:^} 
and  {Rwt}  the  resulting  vector  is  the  displacement  of  the  tool  relative  to  the  wrist: 

{dT^}u,  =  {Rwt}X{ROLL^}  (4.20) 

The  total  predicted  displacement  of  the  tool  in  wrist  coordinates  is  expressed  as  the  sum 
of  the  displacement  of  the  wrist  due  to  the  robot  structure  {dT^^}.^  and  the  displacement 
of  the  tool  relative  to  the  wrist  center,  {dW^jiu  due  to  the  wrist  flexibilities: 

{DT^}^  =  {dW^}^  +  {dT^}^  (4.21) 

Finally,  the  displacement  is  expressed  in  the  tool  coordinate  system  through  a  series 
of  rotations  opposite  of  [Rpw],  otherwise  known  as  [Rwp]: 

{DT^}p  =  [Rwp]{DT,U  (4.22) 

For  the  predetermined  paths  of  the  robot,  much  of  the  matrix  manipulations  can  be 
done  before  they  are  required  and  stored.  The  equation  for  computing  deflections  at  the 
tool  is  written  symbolically  as: 

{DT,}^  =  [Rwp]{[FLEX]^  +  [D  E  F  LU}[Rpw]{Fp}  (4.2-3) 

where  the  [DEFL]^  denotes  the  flexibilities  due  to  the  wrist.  A  FORTRAN  program 
similar  to  this  was  used  to  calculate  the  deflections  at  the  tool.  The  methodology  of 
computing  the  deflections  of  the  robot  at  the  tool  given  the  local  flexibilities  of  the  robot 
structure  and  wrist  was  presented  in  this  section.  Stern  [8]  provides  a  detailed  account 
of  this  technique.  The  software  used  to  predict  the  position  dependant  flexibilities  of  the 
robot  was  derived  from  his  work. 


, rfi»-r"  1  r  !■  nni  »MiiiiiTi 


126 


C 

Q) 
O 

(0 

iH 

a 
en 

-H 

D 


O 
C 

-H 

n 
I 

o 


Time    (second) 


Figure  4.8:  Transient  Displacement  in  Z  at  Point  1  (Adapted  from  [15]) 


Joint  Flexibilities 


It  should  be  noted  here  that  a  majority  of  the  measured  flexibilities  are  due  to  the 
flexibilities  in  the  joint  transmissions  and  drive  systems.  Little  flexibility  of  current  indus- 
trial robots  is  due  to  the  deflection  of  the  actual  links.  As  mentioned  previously  in  this 
section,  the  flexibilities  of  the  shoulder  and  elbow  transmissions  were  not  included  in  the 
flexibility  model  of  the  robot  structure.  This  is  because  these  flexibilities  are  included  in 
the  positional  control  loop  of  those  joints. 

Figure  4.8  shows  the  transient  displacement  of  the  tool  mounting  plate  in  the  Z  direc- 
tion after  a  weight  of  80  pounds  (312  N),  suspended  on  the  end  effector  was  "suddenly" 
lifted.  This  was  not  an  ideal  step  input  as  the  force  release  happened  over  a  finite  period 
of  time.  The  displacement  of  the  end-effector  was  measured  with  a  capacitance  probe 
attached  to  a  rigid  frame.  It  is  seen  that  first  a  deflection  of  0.05  inch  (1.25  mm)  occurs 
in  0.160  sec.  By  then  the  servomotor  is  commanded  by  the  error  detected  by  the  resolvers 
at  the  shoulder  and  elbow,  and  starts  to  eliminate  the  error.  The  system  overshoots,  and 
after  approximately  2  sec,  the  error  is  eliminated.  Superimposed  on  this  motion  is  the 
slowly  decaying  10  Hz  vibration  of  the  first  X-Z  mode  of  the  structure. 

Two  observations  can  be  made  from  this  demonstration.    First,  the  servo  is  able  to 
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compensate  well  for  the  externally  applied  forces  after  a  period  of  two  seconds.  The 
second  observation  is  that  the  reaction  of  the  robot  is  too  slow  to  prevent  the  deflection 
from  occuring.  It  is  apparent  that  the  flexibilities  of  the  shoulder  and  elbow  joints  are 
contained  within  their  respective  positional  control  loop  because  after  the  two  second  time 
period,  the  robot  returns  to  its  initial  position.  If  these  flexibilities  were  not  included  in 
the  control  loop  of  these  two  joints,  then  a  positional  displacement  error  would  result  after 
the  motion  of  robot  damped  out.  From  this  information,  a  model  of  the  servos  can  be 
developed. 

For  simplicity,  just  the  model  of  the  shoulder  will  be  presented  here.  The  model  in- 
cludes: the  servomotor  and  resolver,  the  lead  nut  screw  transmission  and  the  flexibilities 
associated  with  the  transmission.  The  flexibilities  of  the  lead  nut  screw  are  shown  pic- 
torially  in  Figure  4.9  a).  The  command  input  Ycom  is  compared  to  the  actual  position 
sensed  by  the  encoder  and  the  amplified  error  signal  is  used  to  drive  the  servomotor.  The 
servomotor  with  a  transmission  ratio  r  moves  by  X  and  then  drives  the  spring/dashpot  of 
the  lead  nut  screw  transmission  assembly.  The  mass  m  is  then  displaced  by  F,  Figure  4.9 
b).  A  simplified  block  diagram  of  the  system  is  shown  in  Figure  4.9  c).  The  alternative 
feedback  A  would  correspond  to  those  servos  with  external  flexibilities,  such  as  those  found 
in  the  wrist.  The  alternative  feedback  system,  B  corresponds  to  those  servos  with  internal 
flexibilities,  ie.  the  base,  shoulder  and  elbow. 

By  including  those  flexibilities  in  the  positional  loop,  the  servos  may  automatically 
eliminate  the  positional  errors  over  time.  However,  any  external  flexibilities  (feedback  al- 
ternative A)  will  not  be  eliminated  unless  some  external  compensation  means  is  employed. 
The  system  in  Figure  4.9  was  simulated  and  the  results  are  given  in  Figure  4.10  a)  The 
same  system  depicted  in  Figure  4.10  a)  was  then  modified  to  use  the  alternative  feedback 
A  and  simulated  and  the  results  are  shown  in  Figure  4.10  b).  The  deflections  resulting 
from  a  constantly  applied  force  are  never  eliminated  over  time  in  this  case.  Those  deflec- 
tions due  to  the  flexibilities  not  included  in  the  servo  positional  control  loop  are  the  ones 
requiring  attention  and  elimination  with  external  compensation. 
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Figure  4.9:  Model  of  the  Servomeclianism  with  Internal/External  Flexibilities  (Adapted 
from  [32]) 
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Figure  4.10:  Simulation  of  a)  Internal  and  b)  External  Flexibilities  (Adapted  from  [15]) 
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Cutting  Mechanics  for  Edge  Milling 

In  this  section,  a  brief  introduction  to  cutting  mechanics  will  be  presented,  followed 
by  the  single  degree-of- freedom  compensation  methodology  imposed.  For  the  edge  milUng 
task  described  by  the  initial  request  of  the  Office  of  Naval  Research,  light  machining  of 
sheet  aluminum  components  was  to  be  performed.  During  the  milUng  of  these  components, 
two  types  of  variable  forces  are  produced,  the  first  is  the  periodically  variable  component 
due  to  the  rotation  of  the  cutter,  and  the  second  is  variation  of  the  average  force  com- 
ponent. The  variation  of  the  average  force  is  due  to  the  changing  width  of  the  metal  to 
be  removed.  Measurements  of  the  forces  are  presented  and  detailed  characteristics  are 
simulated. 

Traditionally,  this  milling  operation  is  performed  by  high  speed  routers  using  two  fluted 
end  mills.  These  routers  operate  at  high  speed  (18,000  RPM  is  typical).  With  a  two  fluted 
end  mill,  this  produces  a  tooth  frequency  of  600  Hz: 

_  ^8, 000  rev /min  X  2  teeth/ rev 
QO  secjmin 

This  is  a  very  high  frequency  with  respect  to  the  natural  frequencies  of  the  robot  structure 

which  were  found  to  be  less  than  40  Hz.  Therefore  the  vibration  of  the  robot  due  to  the 

high  frequency  of  the  end  mill  is  very  small. 

The  typical  specifications  for  this  application  are:  end  mill  with  a  diameter  d  =  0.375 

to  0.5  inch  (9.53  to  12.7  mm),  aluminum  sheet  metal  with  thickness  t  =  0.1  to  0.2  inch 

(2.5  to  5.1  mm),  and  feedrates  of  10  to  100  inch/min  (0.25  to  2.5  m/min).  This  results  in 

an  average  cutting  force  in  the  range  of  5  to  100  lbs  (22.3  to  445  N),  where  the  cutting 

force  is  proportional  to  the  metal  removal  rate  (MMR).  The  cutting  force  can  be  found 

by  the  following  equation: 

Favg  cc  Kb  *W  *D*Fr  =  Kb  *  MMR  (4.25) 

where 
Favg  -  the  average  cutting  force 
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Figure  4.11:  Experimental  Set-Up  to  Measure  Cutting  Forces 

Kb  -  cutting  stiffness  of  material 

W  -  width  of  cut 

D  -  depth  of  cut 

Fr  -  feedrate  of  tool 

MRR  -  Metal  Removal  Rate 

Prior  to  performing  actual  robotic  milling  experiments,  equivalent  cutting  tests  were 
performed  on  a  large  three  axis  vertical  milhng  machine.  A  small  high-speed  pneumatic 
router  was  attached  to  the  headstock  of  the  milhng  machine,  and  the  aluminum  work  piece 
was  attached  to  a  high  quality  three  degree-of- freedom  table  dynamometer,  Figure  4.11. 
The  workpiece  was  a  0.1875  inch  (4.77  mm)  thick  sheet  of  aluminum,  grade  7075.  The 
pneumatic  spindle  carried  a  0.375  inch  (9.53  mm)  diameter,  two  fluted  router.  The  spindle 
provided  9000  RPM  output  under  load,  corresponding  to  a  tooth  frequency  of  300  Hz.  A 
i  immersion  down  milhng  cut  illustrated  in  Figure  4.12  was  made,  with  a  feedrate  of 
10  in/min  (.25  M/min).  A  time  record  of  the  force  in  the  Y  direction,  Fy  was  recorded 
and  is  shown  in  Figure  4.13  a).  The  forces  generated  as  the  teeth  contact  the  workpiece 
are  clearly  visible  in  Figure  4.13  a).    The  spectrum  of  the  cutting  forces  is  shown  in 
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Figure  4.12:  Forces  Due  to  |  Immersion  Down  Milling  (Adapted  from  [32]) 
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Figure  4.13:  Cutting  Forces  and  Spectrum  for  I  Down  MilIing(Adapted  from  [32]) 
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Figure  4.14:  Simulated  Cutting  Force  for  |  Down  Milling  (Adapted  from  [32]) 


Figure  4.13  b)  and  three  dominant  modes  are  labeled.  The  first  mode  at  300  Hz  is  due  to 
the  contact  force  of  the  cutter,  the  second  mode  at  550  Hz  is  due  to  the  natural  frequency 
of  the  table  dynamometer.  The  third  mode  at  1200  Hz  represents  the  vibration  of  the  end 
mill  cutter.  The  average  or  DC  component  of  the  force  is  obtained  at  the  u;  =  0  Hz  line, 
see  Figure  4.13  c),  and  the  average  force  in  the  Y  direction,  Fyav  =  6.2  lbs  (27.6  N). 

Further  information  about  the  cutting  forces  are  obtained  through  simulation.  A 
simulation  of  the  cutting  process  described  above  was  performed  and  the  force  in  the 
Y  direction,  Fy  is  shown  in  Figure  4.14  and  corresponds  well  to  the  actual  forces  in 
Figure  4.13  a).  Actually,  Figure  4.14  is  more  correct  because  the  record  in  Figure  4.13  a) 
is  distorted  due  to  the  insufficient  bandwidth  of  the  dynamometer. 

The  above  figures  concentrate  on  the  steady  state,  constant  immersion  operation  and 
they  clearly  show  the  periodic  component  of  the  force.  As  mentioned  previously,  the  struc- 
tural deflections  of  the  robot  cannot  follow  such  a  high  frequency.  Instead,  the  deflections 
will  respond  to  the  average  force  applied  to  the  robot  due  to  the  milling  operation.  In 
steady  state  operation,  the  average  force  is  constant  and  is  equal  to  the  measured  DC 
component. 

As  noted  earlier,  as  the  MMR  varies,  the  cutting  forces  vary  proportionally.  A  transient 
due  to  a  variation  of  the  stock  to  be  removed,  i.e.  a  variation  in  the  radial  depth  of  cut  will 
be  evaluated.  Such  a  variation  originates  from  the  fact  that  the  sheet  metal  part  is  first 
cut  by  a  shear  to  an  approximate  shape  and  inevitably,  the  difference  between  this  shape 
and  the  final  desired  shape  will  vary.  An  extreme  case  of  such  a  variation  is  a  step  change 
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Figure  4.15:  Step  Change  in  Workpiece  Material  (Adapted  from  [32]) 
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Figure  4.16:  Simulation  of  the  Average  Cutting  Force  Through  Transients  (Adapted  from 
[32]) 

in  the  metal  to  be  removed,  Figure  4.15.  For  this  step  change,  the  cutter  engages  the  step 
gradually,  and  this  is  defined  as  the  entry  transient.  Similarly,  there  may  be  a  step  down 
in  the  stock  to  be  removed  and  this  constitutes  an  exit  transient.  The  normal  forces  for 
this  case  of  entrance  and  exit  transients  were  simulated  and  are  presented  in  Figure  4.16. 
This  graph  shows  that  when  steps  are  encountered  in  the  workpiece,  the  resulting  cutting 
force  does  not  change  as  a  step.  Furthermore,  steps  in  the  average  cutting  force  are  hardly 
ever  encountered  in  real  cutting  operations  because  the  changes  in  the  workpiece  are  more 
gradual. 

Compensation  Scheme 


In  order  to  compensate  for  the  deflections  caused  by  the  cutting  forces,  a  method  was 
developed  which  includes  three  major  components: 
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Figure  4.17:  Deflection  Compensation  Along  Robot  Path  (Adapted  from  [32]) 

1.  A  position  dependant  flexibility  model  of  the  robot. 

2.  A  dynamometer  to  measure  the  cutting  forces. 

3.  An  additional  short  travel  proportional  servo  which  is  attached  to  the  wrist  of  the 
robot,  and  carries  the  router. 

The  flexibility  model  and  the  cutting  forces  were  described  earlier.  Now  the  requirements 
of  the  additional  servo  will  be  discussed. 

Due  to  the  nature  of  edge-milling,  only  a  single  degree-of-motion  must  be  accurately 
controlled,  and  this  is  in  the  direction  of  the  normal  force,  N,  see  Figure  4.17.  Deflections 
in  the  directions  perpendicular  to  N  do  not  affect  the  machined  contour.  Thus,  only  a 
single  degree-of- freedom  compensator  is  required  to  eliminate  the  deflections  of  the  robot, 
6n-  The  robot  is  then  programmed  so  the  slide  of  the  compensator  is  always  oriented  in 
the  direction  N  of  the  cutting  force.  The  single  degree-of-freedom  position  compensator 
has  been  completely  described  in  the  previous  chapter,  but  a  quick  review  will  be  provided 
here. 

Figure  4.18  illustrates  a  simple  block  diagram  of  the  external  compensator,  and  in- 
troduces its  major  components.  With  the  pre-programmed  path  of  the  robot  known, 
the  position  dependent  flexibility  matrix  is  pre-calculated  at  given  increments  and  stored 
off-line  in  the  controller.  For  a  given  robot  position  along  the  pre-programmed  path, 
the  appropriate  flexibility  matrix  is  taken  out  of  memory  and  multiplied  by  the  external 
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Figure  4.18:  Block  Diagram  of  Flexibility  Compensator 

cutting  forces  measured  in  real  time  by  the  dynamometer.  The  result  is  the  required 
compensatory  displacement.  This  displacement  is  compared  to  the  actual  displacement  of 
the  tool  slide,  and  the  diiference  is  used  to  drive  the  compensator  to  its  desired  position. 
There,  the  cutting  process  produces  new  cutting  forces,  which  in  turn  cause  the  robot  to 
deflect. 

Three  possible  versions  of  the  controlling  program  will  now  be  described.  In  the  first 
version  of  the  controlling  program,  the  user  is  prompted  to  enter  the  flexibilities  in  the 
X,  Y  and  Z  directions.  These  values  would  be  calculated  previously  and  recorded  for  a 
desired  position  of  the  robot.  The  flexibility  values  change  very  little  for  small  motions 
of  the  tool,  so  a  single  set  of  flexibility  values  are  appropriate  for  limited  displacements 
at  the  tool.  Thus,  for  limited  motions  (6  in,  152  mm  or  less  for  example)  a  single  set  of 
flexibility  values  is  valid.  Static  tests  were  performed  using  the  flexibility  compensation 
technique  and  the  results  are  presented  in  the  following  section. 

In  a  second  version  of  the  controlling  program,  a  number  of  different  flexibility  matrices 
could  be  precalculated  for  a  given  path  and  be  recalled  at  the  proper  time.  Because  the 
compensation  controller  does  not  have  direct  knowledge  of  the  location  of  the  end  effector. 
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the  approximate  location  of  the  tool  can  be  estimated.  Knowing  the  starting  point,  the 
direction  of  motion  and  desired  velocity  of  the  end  effector,  the  position  of  the  end  effector 
is  approximately  known  for  any  given  instance  in  time.  However,  if  the  robot  was  stopped 
unexpectedly  or  the  timing  was  inaccurate,  the  estimated  position  would  not  coincide  with 
the  actual  position  of  the  robot  and  the  flexibility  values  would  then  be  erroneous,  causing 
faults  in  the  commanded  compensation  displacement. 

The  desired  compensation  method  would  require  communication  between  the  robot 
controller  and  the  compensator  controller,  so  that  the  exact  location  of  the  end-effector 
or  tool  would  be  known  at  all  times.  Recently,  a  software  package  produced  by  Cincinnati 
Milacron  allows  communication  between  the  robot  controller  and  other  computers,  includ- 
ing PCs.  This  would  be  a  desirable  feature  if  this  method  of  compensation  was  pursued 
further. 

Experiments  and  Results 

Two  kinds  of  performance  tests  were  conducted  on  the  compensator.  First,  static  test 
were  carried  out  in  several  robot  configurations,  and  second,  actual  dynamic  cutting  tests 
were  performed  and  evaluated. 

For  the  static  tests,  a  desired  position  and  orientation  of  the  tool  was  provided,  and  the 
flexibility  coefficients  were  then  produced  off-line  for  those  configurations.  These  values 
were  then  entered  into  the  control  program  and  testing  commenced.  Static  forces  were 
applied  horizontally  to  the  tool  to  simulate  various  cutting  forces.  These  constant  forces 
were  obtained  by  suspending  a  weight  on  a  cable  over  a  pulley  and  attaching  the  other 
end  of  the  cable  to  the  tool.  Capacitance  probes  attached  to  a  rigid  frame  were  used  to 
measure  displacements  of  the  tool  as  the  forces  were  applied. 

In  the  first  position  tested,  the  robot  was  in  a  somewhat  extended  configuration,  see 
Figure  4.19  and  the  actual  position  is  listed  in  the  following  table: 
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Figure  4.19:  T3-776  Robot  in  Extended  Configuration  (Adapted  from  [32]) 


Position  of  End  Effector  For  Extended  Configuration 
Position  (inches)  Orientation  (degrees) 


X 

65.94 

D 

180 

Y 

35.23 

E 

0 

Z 

8.72 

R 

90.2 

Forces  were  applied  in  both  the  X  and  Y  directions  and  the  displacement  was  measured 
parallel  to  the  slide  of  the  compensator  (Y  direction).  The  following  table  illustrates  the 
effects  of  compensation  for  the  various  applied  forces. 


Displacement  In  An  Extended  Configuration 

Force  Deflection  Y  (*10-^  in) 

Direction     Level  (lbs)  Un-compensated     Compensated 

X                   17  2^6                           0 

X                  43  8.9                          0.2 

X                  69  15.5                         0.4 

X                  95  21.1                         0.5 

Y  17  12.4                        0.8 

Y  43  28.4                         1.4 

Y  69  39.5                        2.1 
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Figure  4.20:  T3-776  Robot  in  Retracted  Configuration  (Adapted  from  [32]) 

This  results  in  a  measured  flexibility  of  0.00021  inch/lb  (1.21  +10"^  m/N)  in  the  X 
direction  and  0.00073  inch/lb  (4.21  *10~^  n/N)  in  the  Y  direction.  Deflections  up  to 
0.0395  inch  (0.76  mm)  were  reduced  to  approximately  0.002  inch  (0.051  mm),  an  order  of 
magnitude  in  improvement.  A  similar  test  was  performed,  this  time  with  the  robot  in  a 
somewhat  retracted  conflguration,  as  seen  in  Figure  4.20  and  the  actual  position  is  listed 
in  the  following  table: 


Position  of  End  Effector  For  Retracted  Conflguration 


Position  (inches) 


Orientation  (degrees) 


X  32.51  D 

Y  0.11  E 

Z  8.54  R 


180 
0 
0 


Again,  forces  were  applied  in  both  the  X  and  Y  directions  and  the  measurements  were 
measured  parallel  to  the  slide,  this  time  in  the  X  direction.  The  following  table  shows  the 
result  of  this  static  measurement: 
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Displacement  In  An  Retracted  Configuration 

Force  Deflection  X  (*10~^zn) 

Direction     Level  (lbs)     Un-compensated     Compensated 


X 

17 

5.1 

0.7 

X 

43 

12.1 

1.4 

X 

69 

20.0 

2.3 

Y 

17 

6.72 

0.9 

Y 

43 

16.8 

2.0 

Y 

69 

26.3 

3.1 

For  this  position  the  flexibility  in  the  X  was  equal  to  0.00029  inch/lb  (1.67  *10~^ 
m/N)and  in  the  Y  direction,  the  flexibility  is  equal  to  0.00039  inch/lb  (2.25  *10-^  m/X). 
For  both  configurations,  the  compensator  was  able  eliminate  most  of  the  deflection  error 
and  that  the  remainder  is  acceptably  small.  It  is  conceivable  that  further  improvement 
is  possible  by  better  calibrations  of  the  flexibility  model  or  by  trial  and  error  for  that 
particular  position. 

With  these  results  established,  and  the  flexibility  coefficients  verified,  actual  cutting 
tests  were  performed  in  the  above  mentioned  configurations.  Straight  line  motions  were 
chosen  for  the  tests  because  they  permit  an  easy  and  accurate  evaluation  of  the  results. 
Straight  line  motions  for  articulated  robots  require  as  much  coordinated  motions  between 
the  joints  as  any  curved  motions. 

The  first  cutting  test  was  performed  with  the  robot  in  the  retracted  configuration, 
shown  in  Figure  4.20.  In  this  configuration,  the  robot  was  commanded  to  move  along 
a  straight  path  parallel  to  the  global  Y  direction,  Yg  at  10  inches/min  (25.4  cm/min). 
The  workpiece  was  mounted  on  a  rigid  table  and  oriented  parallel  to  the  Yg  direction 
also.  The  major  force  component  of  the  milling  operation,  the  normal  force,  was  aligned 
approximately  in  the  global  X  direction  Xg.  Thus,  deflections  in  the  Xg  direction  would 
result. 

The  workpiece  was  an  aluminum  alloy,  7075,  sheet  0.1875  inch  (4.76  mm)  thick.  Square 
steps  were  pre-machined  along  its  straight  periphery  and  the  robot  was  programmed  so 
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Figure  4.21:  Workpiece  with  Pre-machined  Steps  and  Simulated  Cutting  Forces  (Adapted 
from  [32]) 
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Figure  4.22:  Uncompensated  Milling  Cut  Along  Yg  (Adapted  from  [32]) 

that  the  cutting  tool  would  remove  those  steps.  Figure  4.21  shows  the  steps,  and  the 
cutter  was  programmed  to  move  along  the  broken  line  in  the  figure.  A  simulation  of  the 
average  resultant  normal  cutting  force  versus  the  cutter  path  is  also  presented,  and  it 
corresponds  to  the  previously  discussed  variation  in  force  shown  in  Figure  4.16. 

The  robot  proceeded  along  the  path,  and  the  cut  was  made  with  the  compensation  both 
active  and  inactive.  Profilograms  were  later  made  of  the  workpieces  by  fixing  the  workpiece 
to  the  table  of  a  milling  machine,  and  attaching  a  capacitance  probe  to  the  headstock  of 
the  milling  machine.  As  the  table  moved  the  workpiece  under  the  capacitance  probe  at  a 
known,  constant  velocity  the  output  of  the  probe  was  recorded  by  a  data  logger.  Using 
this  technique,  very  accurate  records  (+/-  0.001  inch  or  +/-  0.025  mm)  of  the  surface 
workpiece  could  be  produced. 

As  can  be  seen  in  Figure  4.22,  the  profilogram  of  the  workpiece,  produced  without 
using  compensation,  clearly  shows  the  effects  of  the  increased  normal  forces  due  to  the 
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Figure  4.23:  Compensated  Milling  Cut  Along  Yg  (Adapted  from  [32]) 


steps  in  the  workpiece.  Remember  that  the  desired  contour  of  the  workpiece  is  a  straight 
line.  The  unevenness  of  the  surface  is  a  combination  of  both  the  errors  of  the  execution  of 
the  straight  line  motion  of  the  robot  and  the  deflection  due  to  the  cutting  force.  However, 
the  bumps  in  the  profilogram  closely  correspond  to  the  simulated  resultant  average  cutting 
forces  in  Figure  4.21.  The  resulting  displacements  exceed  the  desired  surface  tolerances. 

This  same  test  was  repeated,  and  in  this  instance,  the  compensation  was  active.  Fig- 
ure 4.23  shows  the  resulting  profilograna  for  this  milling  operation.  The  resultant  profile 
of  the  workpiece  shows  little  correspondence  to  the  original  pre-machined  surface. 

A  similar  test  was  performed,  this  time  with  the  robot  in  a  somewhat  extended  config- 
uration, as  illustrated  in  Figure  4.20.  In  this  configuration,  the  robot  was  programmed  to 
traverse  along  a  straight  line  parallel  to  the  global  X  direction,  Xg.  This  results  in  the  nor- 
mal cutting  force  being  applied  along  the  global  Y  direction,  Yg.  Again,  the  workpiece  had 
steps  premachined  on  its  surface,  causing  variations  in  the  normal  cutting  force.  In  this 
case,  as  the  milling  process  occurred,  the  compensation  was  first  left  off,  then  activated 
and  finally  turned  off  again.  In  Figure  4.24,  the  steps  of  the  workpiece  are  superimposed, 
and  the  transitions  between  the  compensated  and  uncompensated  regions  are  indicated. 
Displacements  of  0.010  to  0.020  inch  (0.25  to  0.50  mm)  in  the  uncompensated  region  were 
reduced  to  approximately  0.003  to  0.005  inch  (0.076  to  0.127  mm)  in  the  compensated 
region.  Again,  errors  of  the  path  show  up  in  this  figure. 

An  additional  source  of  error  is  due  to  the  rather  course  resolution  of  the  force/torque 
sensor,  +/-  1  pound  (4  N).  The  maximum  normal  force  generated  by  the  milling  operation 
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Figure  4.24:  Profilogram  of  Workpiece  From  Extended  Configuration  (Adapted  from  [32]) 


was  equal  to  approximately  12  pounds  (48  N),  thus  the  maximum  round-off  error  due  to 
the  coarse  resolution  would  approach  8%  or  between  0.001  and  0.002  inch  (0.025  and  0.050 
mm).  For  heavier  cuts,  or  by  using  a  more  accurate  force  transducer,  the  round-off  error 
due  to  the  coarse  resolution  could  be  significantly  reduced. 

The  execution  of  the  straight  line  path  without  any  externally  applied  forces  has  errors 
on  the  order  of  0.005  to  0.010  inch  (0.125  to  0.25  mm).  These  errors  are  of  the  same 
magnitude  as  those  deflections  resulting  from  the  forces  produced  by  the  milling  operation. 
That  is  why  the  profilograms  for  the  compensated  milling  operations  exhibit  non-smooth 
surface  finish.  It  should  be  mentioned  that  the  test  cuts  were  rather  light,  because  the 
spindle  used  was  a  low  power  one  and  often  the  Metal  Removal  Rate  is  two  to  four 
times  heavier.  This  would  correspond  in  proportionally  larger  deflections,  which  could  be 
effectively  eliminated  with  the  active  compensation.  The  tests  which  were  conducted  at 
the  power  limit  of  the  router,  any  larger  MRR  would  have  stalled  the  router. 

To  fairly  test  the  dynamic  capabilities  of  the  deflection  compensation  scheme,  an  ad- 
ditional experiment  should  be  performed.  The  external  compensator  and  the  force/torque 
transducers  should  be  mounted  to  the  headstock  of  a  milling  machine  via  a  flexible  cou- 
pling as  illustrated  in  Figure  4.25.  The  single  degree-of-freedom  flexible  coupling  would 
provide  a  constant  flexibility  approximately  equal  to  that  encountered  by  the  robot.  The 
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Figure  4.25:  Dynamic  Deflection  Compensation  Capability  Evaluation  Setup 
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Figure  4.26:  Straight  Line  Measurement  Fixture 

milling  machine  would  provide  a  high  precision,  straight  line,  constant  velocity  motion. 
This  would  eliminate  the  straight  line  motion  errors  encountered  with  the  T3-776  robot 
and  would  allow  an  unbiased  evaluation  of  the  complete  deflection  compensation  system. 
Steps  would  again  be  premachined  into  the  workpiece  as  previously  described,  varying  the 
normal  cutting  forces. 

To  demonstrate  the  poor  execution  of  straight  line  motion,  the  robot  was  commanded 
to  repeat  the  path  which  was  used  for  the  retracted  cutting  test.  A  capacitance  probe 
was  attached  to  the  end  effector  of  the  robot,  and  finely  machined  right  angle  bracket  was 
mounted  on  the  work  table  as  illustrated  in  Figure  4.26.  The  capacitance  probe  could 
then  directly  measure  the  displacement  of  the  deviation  of  the  robot  along  the  straight 
line  path.  The  profilogram  is  presented  in  Figure  4.27  and  deviations  of  up  to  0.010  inch 
(0.25  mm)  are  evident.  It  should  be  noted  that  this  motion  is  highly  repeatable,  as  this 
same  motion  was  repeated  several  times,  and  the  profilograms  were  superimposed.  The 
difference  was  less  than  0.002  inch  (0.050  mm). 

In  conclusion,  the  flexibility  modeling  and  deflection  compensation  were  successful, 
however,  the  results  were  somewhat  overshadowed  by  the  poor  straight  line  motion  of  the 
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Figure  4.27:  Proiilogram  of  the  Straight  Line  Motion  of  Robot  In  Retracted  Configuration 


robot.  The  static  tests  showed  that  the  deflections  due  to  applied  force  could  be  almost 
completely  eliminated  given  the  proper  flexibility  coefficients. 


CHAPTER  5 
IMPROVING  THE  STRAIGHT  LINE  PERFORMANCE  OF  AN  INDUSTRIAL 

ROBOT 


The  surface  quality  of  the  parts  described  in  the  previous  chapter  were  of  sub-standard 
quality  even  after  employing  flexibility  compensation.  This  was  in  part  due  to  the  poor 
straight  line  motion  of  the  robot.  Without  any  external  loads  applied,  the  straight  line 
motion  of  the  robot  was  poor,  deviations  of  +/-  0.015  inch  (0.38  mm)  from  the  desired 
path  were  encountered.  By  improving  the  straight  line  motion  of  the  robot  and  then 
adding  deflection  compensation,  the  dynamic  cutting  results  could  be  greatly  improved, 
thus  meeting  the  requirements  of  templateless  edge  milling. 

In  general,  straight  line  motions  of  the  robot  are  representative  of  all  desired  smooth 
motion  of  the  robot.  Straight  line  motions  have  the  distinct  advantages  over  other  types 
of  smooth  motions  (curved  motions  for  example),  because  they  are  typically  easier  to 
program  and  records  of  the  motions  are  simpler  to  obtain.  Thus  any  improvement  in  the 
straight  line  motion  of  the  robot  would  also  help  to  improve  any  desired  smooth  motion 
of  the  end-effector.  In  this  section,  several  items  related  to  improving  the  straight  line 
motion  of  the  robot  will  be  discussed,  including: 

•  Probable  causes  of  poor  straight  line  motion  of  the  robot. 

•  Several  corrective  methods  which  were  investigated. 

•  The  simulation,  implementation  methodology  and  results  of  an  accelerometric  com- 
pensation method. 

Cartesian  motions  are  used  in  a  number  of  robots,  where  the  configuration  of  the 
hand  (or  the  tool)  is  specified  in  Cartesian  coordinates  at  specific  points  along  the  path. 
Obviously,  transformations  are  required  to  provide  the  necessary  joint  coordinates  from 
the  recorded  cartesian  coordinates.    The  Cincinnati  Milacron  T3  series  robots  move  the 
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hand  along  "straight"  lines  from  each  programmed  point  with  controlled  velocity  and 
acceleration,  [56]. 

There  are  several  general  methods  which  are  used  to  generate  the  motion  of  the  robot 
between  taught  points.  One  of  the  initial  methods  was  developed  in  1974  by  Paul  [57,58] 
where  intermediate  points  are  interpolated  at  regular  intervals  along  the  path.  These 
interpolated  points  are  then  back  transformed  to  joint  coordinates,  and  are  used  to  drive 
the  individual  servos.  A  similar  method,  where  the  intermediate  points  are  evaluated  every 
100  msec  was,  was  also  proposed  by  Paul.  A  second  method  requires  the  motion  sequences 
of  the  end  effector  to  pass  through  "knot"  points.  This  method  leaves  the  undefined 
motions  between  the  knot  points,  which  could  lead  to  excess  errors  at  the  end  effector.  A 
third  approach  adds  enough  intermediate  points  so  that  the  manipulator  may  be  controlled 
by  linear  interpolations  of  joint  values  without  allowing  the  hand  to  deviate  more  than 
a  pre-specihed  amount  from  a  straight  line  Cartesian  path.  This  substantially  reduces 
the  amount  of  real  time  computation  required  to  drive  the  machine  and  permits  problems 
arising  from  degenerate  joint  alignments  to  be  handled  more  easily,  [59].  However,  all  of 
these  methods  rely  on  the  ideal  situation  of  knowing  the  exact  position  of  each  joint,  and 
the  assumption  that  the  actual  geometric  features  of  the  robot  correspond  to  the  model 
used  in  the  transformations. 

Probable  Causes  of  Poor  Straight  Line  Motion 

In  the  introductory  section,  several  factors  are  listed  as  probable  sources  of  positional 
error  at  the  end-effector  and  most  of  those  factors  are  directly  related  to  the  poor  straight 
I  line  motion  of  the  robot.  Many  of  these  factors  not  only  affect  the  motion  capabilities  of 

the  robot,  but  the  absolute  positioning  of  the  robot  also.  The  factors  causing  these  errors 
include  environmental  factors,  kinematic  factors,  dynamic  factors,  measurement  factors 
and  computational  factors. 

In  the  previous  chapters,  dynamic  factors  such  as  structural  flexibilities  and  varying 
inertia!  loads  were  described  in  detail  and  methods  to  eliminate  those  effects  were  sim- 
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ulated  and  demonstrated  with  positive  results.  However,  the  improvements  realized  by 
the  implementation  of  the  structural  flexibility  compensation  are  overshadowed  by  the 
inherent  poor  straight  line  motion  of  the  robot.  This  trait  of  poor  straight  line  motion 
greatly  reduces  the  potential  applications  for  this  particular  robot  and  other  similar  types 
of  industrial  robots. 

It  was  out  of  the  scope  of  this  research  to  attempt  to  improve  the  straight  line  motion 
of  the  robot  by  increasing  the  resolution  of  the  encoders,  reducing  geartrain  backlash, 
providing  additional  significant  bits  in  the  controller  or  compensating  the  geometric  errors 
of  the  kinematic  equations  of  motion.  Instead,  a  set  of  requirements  was  established  for 
the  system  necessary  to  improve  the  straight  line  motion  of  the  end-effector: 

•  The  compensation  scheme  could  be  implemented  on  the  T3-776  robot  without  having 
to  make  any  modifications  to  the  existing  resolvers/encoders,  geartrain,  controllers, 
etc. 

•  The  compensation  scheme  should  be  generic  so  that  it  could  be  implemented  on 
other  makes  and  models  of  industrial  robots  without  making  modifications  to  the 
compensator. 

•  The  compensation  system  would  be  a  self  contained  device,  which  did  not  rely  on 
the  capabilities  of  the  existing  robot. 

From  the  previous  chapter,  deviations  of  up  to  +/-  0.010  inch  (0.25  mm)  were  recorded 
for  a  typical  straight  line  motion.  However,  this  motion  was  repeatable,  within  +/-  0.003 
inch  (0.076  mm)  for  one  particular  straight  line  path.  Theoretically,  if  all  motions  of  the 
robot  were  exactly  repeatable,  the  trajectory  errors  could  be  recorded  and  compensated 
for  in  future  playbacks.  However,  the  displacement  error  is  not  highly  repeatable  in  some 
instances,  due  to  changes  in  external  forces,  friction,  temperature,  and  other  environmental 
factors. 

In  the  next  section,  several  methods  of  improving  the  straight  line  motion  of  the  robot 
will  be  discussed.  These  methods  will  not  require  any  previous  knowledge  of  the  positional 
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error. 


Methods  to  Eliminate  Straight  Line  Motion  Errors 

Several  methods  to  eliminate  straight  line  motion  errors  were  explored.  These  methods 
were  designed  to  be  robot  independent  and  somewhat  portable,  where  the  compensator 
could  be  implemented  on  many  different  types  of  industrial  robots,  as  in  the  flexibility 
compensation  task.  The  methods  include: 

•  Adaptive  direct  positional  feedback  via  a  target  following  scheme.  The  desired  tool 
path  would  be  inscribed  on  the  work  piece  and  an  integral  vision  system  would 
provide  feedback  directly  to  the  compensation  servo. 

•  A  non-contact  visual  tracking  system  consisting  of  three  laser  interferometers,  a  tar- 
get retroreflector,  target  tracking  system  and  controller  which  calculates  the  position 
of  the  target  in  Cartesian  coordinates.  Through  triangulation,  an  accurate  position 
of  the  end-effector  could  be  provided  through  out  the  work  space  of  the  robot  in  real 
time. 

•  A  force  feedback  method,  where  forces  at  the  end  effector  (currently  monitored  for 
the  flexibility  compensation)  could  be  used  to  help  maintain  smooth  motions  during 
straight  line  motions. 

•  Direct  displacement  feedback  using  a  displacement  probe.  A  capacitance  probe  or 
linear  velocity  displacement  transducer  (LVDT)  would  measure  the  straight  line 
performance  of  the  robot  and  would  control  the  position  of  the  compensation  servo. 

•  Adaptive  positional  feedback  via  accelerometric  measurements  at  the  tool  holder. 
These  signals  would  be  integrated  twice  revealing  positional  information  and  that 
information  would  be  used  to  control  the  compensation  servo. 

It  is  obvious  that  templates  could  be  used  to  guide  the  end-effector  along  straight 
trajectories.  However,  the  main  thrust  of  this  research  was  to  provide  accurate  positional 
control  at  the  tool  without  the  use  of  templates. 
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Figure  5.1:  Direct  Visual  Feedback  Scheme 
Adaptive  Direct  Visual  Feedback 

Direct  visual  feedback  schemes  could  be  used  to  improve  the  straight  line  motion  of 
the  end  effector.  They  would  also  be  useful  in  reducing  positional  errors  due  to  most  other 
described  causes  including  structural  flexibility,  inadequate  encoder  resolution,  etc.  Tliis 
method  of  compensation  would  require  the  desired  tool  path  to  be  inscribed  directly  onto 
the  workpiece  and  in  many  instances,  this  would  require  a  scribing  template  to  be  made 
for  each  different  type  of  part. 

As  in  the  robot  structure  flexibility  compensation  scheme,  this  direct  visual  compen- 
sation scheme  would  utilize  an  external  compensation  servo  which  is  kept  normal  to  the 
desired  tool  path  at  all  times.  Figure  5.1  schematically  represents  the  direct  visual  feed- 
back mechanism. 

The  direct  visual  feedback  scheme  would  incorporate  a  visual  feedback  device  such 
as  a  CCD  video  camera.  The  camera  would  be  fixed  to  the  compensator,  directly  above 
the  router  and  the  tool  path  would  remain  within  the  camera's  field-of-view  at  all  times. 
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The  output  of  the  visual  sensor  array  of  the  camera  would  be  directly  ported  to  an  array 
processor  located  in  a  IBM  PC- AT  (or  equivalent  clone)  and  be  processed  in  a  real  time 
fashion.  The  standard  RS  170  video  rate  is  60  Hz,  interlaced.  This  would  provide  a  real 
time  visual  feedback  tool  at  a  reasonable  price. 

The  control  scheme  would  require  that  the  inscribed  tool  path  be  kept  centered  in  the 
visual  array.  An  algorithm  would  locate  the  image  of  the  inscribed  tool  path  and  if  the 
tool  path  deviated  away  from  the  center  of  the  visual  array,  an  error  signal  proportional 
to  the  positional  error  would  be  directed  to  the  external  compensation  servo  (described 
earlier)  and  cause  the  tool  to  be  moved  back  to  the  center  of  the  visual  array. 

This  compensation  scheme  could  be  implemented  rather  easily  and  with  little  addi- 
tional cost.  A  high  resolution  CCD  camera,  lens,  array  processor  and  light  source  could 
be  purchased  for  approximately  $6000.  A  camera  and  light  bracket  would  have  to  be  de- 
signed, manufactured  and  installed  on  the  robot.  The  compensator  controller  could  reside 
on  a  single  PC  with  the  array  processor  and  I/O  ports  on  the  same  backplane,  increasing 
the  speed  of  the  control  loop. 

Not  only  would  errors  due  to  poor  straight  line  motion  be  eliminated,  but  all  other 
errors  including  those  due  to  structural  flexibilities  could  be  eliminated  in  real  time.  As 
mentioned  previously,  the  major  drawbacks  of  this  method  of  compensation  are:  scribing 
templates  must  be  created  for  each  different  type  of  part  and  each  workpiece  would  require 
the  tool  path  to  be  inscribed  on  it.  For  these  reasons,  this  method  of  compensation  was 
not  pursued  for  further  development. 

Non-Contact  Visual  Feedback 

Non-contacting  visual  tracking  systems  were  also  explored.  These  systems  would  re- 
quire a  target  to  be  placed  on  the  robot  as  close  to  the  tool  (end  mill)  as  possible.  A 
target  following  mechanism  would  then  provide  the  absolute  location  of  the  target  in  real 
time  to  the  compensation  controller.  The  actual  position,  in  Cartesian  World  coordinates, 
measured  by  the  tracking  system  would  be  compared  to  the  desired  position  of  the  target 
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Figure  5.2:  Laser  Interferometric  Robot  Arm  Position  Measurement  System 


and  the  difference  of  tliese  two  values  would  be  used  to  control  the  compensation  servo 
mechanism.  Again,  a  single  degree-of-freedom  compensator  could  be  used  for  the  milhng 
operation.  However,  this  method  could  provide  positional  errors  in  X,Y  and  Z  coordi- 
nates. For  more  difficult  tasks,  a  three  degree-of-freedom  compensator  could  be  developed 
to  take  advantage  of  the  additional  information. 

When  a  target  spherical  retroreflector  is  attached  to  the  end  effector  of  the  robot,  a 
single  tracking  interferometer  could  automatically  follow  the  arm  and  measure  its  radial 
position  within  -I-/-  0.04  inch  (1.0  mm).  For  improved  precision,  three  trackers  are  used 
to  measure  three  radial  distances,  see  Figure  5.2.  With  the  three  radial  displacements 
accurately  known,  position  is  calculated  geometrically  using  the  trilateration  method. 
Calculated  root  mean  square  error  in  Cartesian  coordinates  is  less  than  6  microns  for  a 
three  meter  cube  as  claimed  by  a  vendor,  Chesapeake  Laser  Systems  [60].  A  particular 
device  built  by  Chesapeake  Laser  Systems  was  designed  to  "meet  the  requirements  of  nu- 
merous applications  in  which  fast,  noncontact  measurements  on  the  order  of  a  thousandth 
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of  an  inch  are  needed  over  a  large  volume.  This  method  can  give  machine  tool  accuracy 
to  robots,  thereby  extending  their  applications." 

The  trackers  operate  by  emitting  a  relatively  low  power  (1  miliwatt)  laser  beam  from 
a  HeNe  laser.  The  beam  strikes  the  target,  a  retroreflective  lens,  and  the  reflection  is 
detected  by  a  quadrant-photodetector.  The  quadrature  sensor  is  basically  a  light  sensitive 
disk  broken  into  quadrants  whose  analog  outputs  are  sent  to  a  bridge  type  comparator. 
The  comparator  then  provides  an  analog  signal  related  to  the  direction  of  the  positional 
error  of  the  elevation  and  azimuth  of  the  tracker.  As  the  reflected  laser  beam  strays 
from  the  center  of  the  quadrant-photodetector,  it  provides  an  error  signal  to  the  servo 
controller,  and  the  error  is  eliminated  over  time.  The  servos  try  to  maintain  the  position 
of  the  reflected  beam  in  the  center  of  the  quadrature. 

After  an  appropriate  calibration  routine,  the  position  of  the  retroreflectors  can  be 
obtained  by  two  methods.  The  first  method  mentioned  earlier  involves  the  use  of  three 
interferometers.  The  second  method  uses  a  single  interferometer,  where  the  radial  distance 
is  measured  and  the  azimuth  and  elevation  as  measured  by  the  shaft  encoders  on  the 
tracker  are  used.  A  simple  transformation  would  convert  the  spherical  coordinate  inputs 
{T,d,(f))  to  Cartesian  coordinates. 

The  single  tracker  with  measurement  of  the  two  angles  appears  to  offer  the  better 
solution  at  first  glance.  However,  closer  examination  reveals  certain  problems:  the  angle 
measurement  assumes  that  the  tracker  is  locked  onto  the  retroreflector  with  zero  error.  No 
practical  dynamic  tracking  servo  system  is  error  free.  In  fact  the  error  in  the  angle  shows  up 
as  a  large  tangential  error.  While  some  dynamic  compensation  is  possible  if  the  magnitude 
and  direction  of  the  errors  are  known,  dynamic  and  high  accuracy  measurements  are  more 
difficult  with  this  system  than  with  multiple  trackers. 

Triangulation  with  three  or  more  tracking  interferometers  does  not  require  high  accu- 
racy angular  encoders,  because  the  only  function  of  the  servo  system  is  to  keep  the  tracker 
locked  onto  the  retroreflector.  Such  a  system  can  dispense  with  the  large,  high  accuracy 
encoders  and  simplify  the  mechairical  design.  Any  error  in  angular  alignment  shows  up  as 
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a  cosine  error  in  the  interferometer  radial  measurement.  Sucli  errors  are  insignificant  for 
near  normal  incidence,  particularly  when  the  primary  error  is  on  the  order  of  0.001  inch 
(0.025  mm).  In  addition,  the  distance-measuring  interferometer  can  be  sampled  at  a  rate 
in  excess  of  100  Hz  and  can  provide  accurate  measurements  (+/-  0.001  inch  or  0.025  mm) 
at  those  speeds,  [60]. 

The  main  limitation  involved  in  applying  laser  interferometry  technology  is  cost.  As  of 
October  1987,  the  total  cost  of  implementing  three  tracking  interferometers,  the  controller 
and  other  necessary  hardware  totals  approximately  $150,000  [60].  Also  there  is  a  limit 
to  the  maximum  radial  tracking  velocity,  12  in/sec  (0.30  m/sec).  However,  with  the 
high  accuracy  and  update  rate,  laser  interferometry  appears  to  be  an  excellent  method 
to  monitor  the  position  of  the  end  effector.  As  mentioned  earlier,  the  measured  position 
would  be  compared  to  the  desired  position  and  the  difference  would  be  used  to  control  the 
external  single  degree-of-freedom  compensator.  This  method  of  compensation  was  also 
eliminated  at  this  time  because  of  costs. 

Force  Monitoring  Compensation 

Straight  line  motion  of  the  end  effector  and  tool  could  be  improved  by  monitoring 
the  cutting  forces  with  the  force/torque  sensor  at  the  wrist.  From  a  previous  section  on 
cutting  force  mechanics,  it  can  be  shown  that  during  a  cut  with  constant  feed  rate  and 
depth  of  cut,  the  resulting  cutting  forces  are  constant.  Obviously,  this  would  be  true  if 
the  tool  was  making  a  slotting  cut  with  a  constant  feedrate,  indicating  a  constant  metal 
removal  rate.  Any  variation  in  either  the  tangential  or  normal  force  during  a  slotting  cut 
with  constant  feed  would  indicate  a  deviation  from  the  desired  straight  line  motion  of  the 
tool.  By  requiring  the  average  normal  force  to  remain  constant,  the  displacement  of  the 
compensator  could  be  controlled  through  a  force  loop. 

Previously,  it  was  assumed  that  the  amount  of  material  to  be  removed  varied  along 
the  tool  path.  If  it  is  now  required  that  the  amount  of  flash  (material  to  be  removed)  is 
constrained  to  be  greater  than  the  diameter  of  the  routing  tool,  then  the  tool  will  always 
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be  engaged  in  a  slotting  cut.  Thus,  the  normal  and  tangential  forces  calculated  from  the 
dynamic  cutting  model,  would  be  known  for  the  entire  cutting  operation. 

Assuming  that  the  desired  tool  path  is  accurately  known,  the  compensator  is  always 
maintained  normal  to  that  desired  trajectory,  and  the  cutter  moves  along  the  workpiece 
at  a  constant  velocity,  then  the  normal  and  tangential  forces  as  measured  by  the  com- 
pensator should  remain  constant.  Any  motion  of  the  cutting  tool  normal  to  the  desired 
trajectory  (due  to  the  poor  straight  line  motion  of  the  robot)  would  cause  the  normal  force 
to  vary.  Since  this  measured  normal  force  would  be  different  than  the  desired  normal  force, 
a  force  error  would  be  produced,  and  this  force  error  would  be  used  to  drive  the  external 
compensator/tool  back  to  the  desired  position.  This  method  has  been  successfully  simu- 
lated using  a  model  of  the  compensation  servo  mechanism  and  inputting  a  sinusoidal  force 
perturbation. 

The  simulation  contained  a  simplified  single  degree-of- freedom  flexibility  model,  and 
the  controlling  equation  was  implemented  as  follows: 

Xn  =  [FLEX]*{2*Fa-Fc)  (5.1) 

where 

Xn  -  the  desired  compensation  displacement  in  the  normal  direction 
[FLEX]  -  the  one  dimensional  flexibility  value  in  the  normal  direction 
Fa  -  the  actual  measured  normal  force 
Fc  -  the  computed  desired  normal  force 

When  the  robot  was  following  its  desired  trajectory,  the  measured  normal  force  would 
be  equal  to  the  computed  normal  force  and  the  equation  would  be  simplified  as  follows: 

Xn  =  [FLEX]  *  Fa  (5.2) 

This  is  equivalent  to  the  one  dimensional  case  of  the  flexibility  compensation  scheme  dis- 
cussed in  the  previous  chapter.  Thus,  this  scheme  would  allow  compensation  for  positional 
errors  due  to  both  flexibilities  of  the  robot  structure  and  for  the  poor  straight  line  path 
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performance  of  the  robot.  The  same  force  dynamometer  and  single  degree-of- freedom 
compensator  would  be  used  as  previously  described. 

The  flexibility  value,  [FLEX]  includes  all  flexibilities  of  the  robot  and  compensator  in 
the  normal  direction  of  the  cut.  However,  if  the  flexibility  of  the  compensator  was  made 
much  greater  than  that  of  the  robot,  it  would  be  unnecessary  to  develop  a  highly  accurate 
model  of  the  robot  structure  flexibilities  in  the  normal  direction.  This  would  eliminate 
the  requirement  of  detailed  flexibility  modeling,  only  simple  static  measurements  would 
be  needed  to  improve  the  accuracy. 

As  mentioned  earlier,  this  method  would  require  that  the  routing  tool  be  engaged  in 
a  slotting  cut  at  all  times,  which  might  not  be  feasible  in  some  instances.  In  addition, 
the  force  must  be  accurately  measured  in  a  real  time  fashion.  Presently,  the  force/torque 
transducer  used  has  a  reasonable  update  rate  (100+  Hz),  but  the  resolution  is  inadequate. 
The  resolution  of  the  force  transducer  is  +/-  1  pound  (4.45  N),  and  the  typical  normal 
force  attainable  for  the  slotting  cut  is  5  and  20  pounds  (22.3  and  89.0  N).  The  poor  res- 
olution of  the  force/torque  transducer  would  introduce  compensation  errors,  as  described 
in  the  previous  chapter.  However,  a  high  resolution  force  sensor  could  be  developed  and 
incorporated  with  the  external  compensator.  As  single  degree-of-freedom  device  could  be 
built  and  installed  parallel  to  the  slide  mechanism  of  the  compensator,  in  that  way,  the 
normal  cutting  forces  would  be  directly  monitored. 

This  method  would  only  be  useful  during  the  steady  state,  full  immersion  cut.  Entrance 
and  exit  cuts  in  addition  to  variable  feedrates  would  result  in  poor  compensation.  Thus, 
this  method  of  improving  the  straight  line  performance  was  also  abandoned. 

Direct  Displacement  Feedback 

The  displacement  of  the  tool  from  the  desired  path  could  be  directly  measured  with  a 
displacement  probe.  As  mentioned  previously,  a  capacitance  probe  was  used  to  measure 
the  displacement  of  the  end  effector  from  the  desired  path.  The  probe  produces  an  ana- 
log output  proportional  to  the  measured  displacement,  and  this  signal  could  be  used  to 
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Figure  5.3:  External  Compensator  Calibration  Setup 

drive  the  external  compensator.  This  method  of  compensation  was  tested  with  excellent 
results.  However,  a  guide  or  displacement  reference  (template)  must  again  be  used  for  the 
measurement  reference. 

When  the  displacement  errors  of  the  robot  path  were  being  measured,  it  was  apparent 
that  the  analog  signal  being  recorded  by  the  data  logger  could  also  be  used  to  drive  the 
compensating  servo.  A  method  of  using  the  probe  to  control  the  compensator  was  devel- 
oped. First  a  means  of  calibrating  the  compensation  technique  was  devised.  Figure  5.-3 
shows  the  calibration  setup,  where  two  identical  displacement  probes  were  used.  The  first 
probe  was  attached  to  the  compensator,  the  second  probe  was  attached  to  static  fixture, 
where  the  displacement  could  be  changed  as  required.  The  output  of  both  probes  were  first 
sent  to  a  conditioning  amplifier  and  then  to  a  data  logger.  The  output  of  the  first  probe 
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was  also  directed  to  the  motor  controller.  In  the  motor  controller,  the  actual  position 
of  the  compensator  Xa,  was  subtracted  from  the  desired  position  x^,  and  the  difference 
was  used  to  drive  the  position  of  the  compensator.  The  gain  of  xj,  was  adjusted  until 
the  displacement  of  first  probe  xi  was  equal  to  the  second  probe  X2.  Additionally,  the 
velocity  feedback  gain  was  adjusted  so  that  the  system  was  critically  damped,  eliminating 
overshoots  for  step  inputs  in  position. 

Next,  a  dynamic  test  was  performed  by  commanding  the  robot  to  traverse  along  a 
straight  trajectory,  parallel  to  the  global  Y  axis.  The  right  angle  bracket  was  mounted 
on  the  table  parallel  to  the  desired  path,  and  the  capacitance  probe  would  then  detect 
error  displacements  from  the  straight  line  motion.  During  the  first  pass,  the  compensator 
was  turned  off,  and  the  resulting  deviations  were  recorded  on  the  data  logger.  The  path 
was  repeated,  and  during  this  trial  the  compensator  was  activated.  Because  the  motion 
of  the  robot  along  this  trajectory  is  highly  repeatable,  this  method  of  comparing  the 
uncompensated  and  compensated  motion  appeared  to  be  accurate. 

The  uncompensated  motion  had  deviations  of  approximately  +/-  0.010  inch  (0.25 
mm),  as  described  in  the  previous  chapter.  However,  the  compensated  system  was  able  to 
reduce  motion  errors  to  less  than  +/-  0.002  inch  (0.050  mm).  These  displacement  errors 
may  have  been  further  reduced  if  the  bandwidth  of  the  servo  had  been  greater. 

This  method  of  compensation  provides  a  closed  loop  control  mechanism  which  elimi- 
nates all  sources  of  trajectory  errors,  including  errors  due  to  structural  flexibilities.  This 
method  still  requires  a  "template"  to  be  attached  to  the  work  piece  to  guide  the  robot. 
However,  it  would  be  a  light  weight  device  because  no  contact  would  be  made  between 
the  template  and  the  tool.  For  straight  line  motion,  this  method  of  compensation  would 
be  quite  simple  to  implement.  Complex  three  dimensional  trajectories  would  greatly  com- 
plicate this  compensation  method,  because  three  dimensional  guides  would  have  to  be 
provided.  Thus  the  accelerometric  compensation  was  pursued  where  no  templates  would 
be  required. 
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Figure  5.4:   Record  of  Acceleration,  Velocity  and  Position  Using  Cascading  Integrators 
(Adapted  from  [62]) 

Accelerometric  Positional  Feedback 

Accelerometric  feedback  has  been  used  successfully  as  a  means  of  keeping  track  of 
the  position  of  objects  for  over  20  years.  Inertial  guidance  systems  use  accelerometer 
measurements  to  obtain  positional  information  with  high  resolution  over  extended  periods 
of  time.  Examples  of  these  inertial  systems  include  missiles,  weapons  and  aircraft  guidance. 

Accelerometers  were  also  used  in  the  early  1960's  for  Shock  Measurement  Systems. 
The  signals  were  integrated  and  double  integrated  to  provide  velocity  and  positional  in- 
formation, respectively.  The  applications  for  these  systems  required  a  linear  response  over 
a  wide  dynamic  range,  "acceleration  signals  of  less  than  one  tenth  of  a  "g"  to  several 
thousand  "g"  occur  over  a  range  of  near  static  (zero  frequency)  to  many  kilocycles"  [61]. 
Accelerometers  were  attached  to  the  missiles  under  investigation.  The  accelerometer  sig- 
nals were  recorded  on  a  magnetic  tape  recorder,  and  the  recorded  signals  were  integrated 
and  double  integrated  and  recorded  on  a  strip  chart  recorder.  Figure  5.4  provides  an  ex- 
ample of  the  dynamic  results  of  the  integration  technique.  Several  things  should  be  noted 
in  Figure  5.4.  The  time  records  were  for  relatively  short  time  periods,  100  ms.  A  drift 
in  the  positional  signal  results  in  that  record  sloping  upward  as  time  progresses;  however, 
the  change  in  position  is  plainly  evident. 

Oleson  [62]  points  out  that  the  accelerometer  and  integrator  must  be  stable  at  the 
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lowest  signal  levels,  linear  over  the  full  dynamic  range  required  and  not  adversely  affected 
by  noise.  A  combined  amplifier  integrator  circuit  was  developed  over  a  period  of  years 
to  meet  the  conditions  above.  The  circuit  consisted  of  a  very  stable  voltage  controlled 
oscillator  supplying  a  series  of  fixed  charge  increments  to  an  integrating  capacitor.  The 
long  time  average  of  the  capacitor  voltage  is  held  at  zero  by  incorporating  a  feedback  loop. 

The  integrators  incorporated  a  second-order  cut-off  filter  that  imposed  a  limit  on  the 
time  interval  over  which  accurate  integration  could  be  obtained.  As  pointed  out  in  Oleson 
[62],  any  practical  integrator  requires  a  low  frequency  cut-off  to  compensate  imperfect 
stability.  This  attenuates  the  low  frequency  response  of  the  integrator.  Due  to  the  ad- 
vancement in  electronics  over  the  past  twenty  years,  it  was  intuitive  that  the  integrators 
could  be  improved,  so  that  they  could  be  operated  over  longer  durations,  without  drift 
and  within  the  necessary  frequency  range  required  by  the  compensator.  However,  as  will 
be  discovered  in  the  next  section,  even  with  modern  components  and  design  techniques, 
integration  of  low  frequency  signals  is  a  demanding  task. 

For  the  compensation  scheme  used  to  improve  the  straight  line  motion  of  the  robot,  a 
single  accelerometer  is  attaclied  to  the  external  servo,  oriented  parallel  to  the  motion  of 
the  slide  table  of  the  compensator.  Thus,  any  motions  of  the  tool  normal  to  the  desired 
path  of  the  tool  would  be  detected  by  the  accelerometer,  and  used  by  the  compensation 
scheme  to  eliminate  those  errors.  This  open  loop  system  would  detect  acceleration,  pre- 
dict displacement  and  correct  for  positional  errors  in  a  real  time  fashion.  Accelerometric 
compensation  will  be  discussed  in  detail  in  the  following  section. 

Accelerometric  Compensation 

As  mentioned  previously,  by  double  integrating  the  output  of  an  accelerometer,  posi- 
tional information  can  be  obtained.  In  the  ideal  case,  six  properly  oriented  accelerometers 
could  be  attached  to  the  end  effector  of  the  robot,  and  the  position  of  the  end  effector  could 
be  accurately  estimated  at  all  times.  Unfortunately,  real  accelerometers  and  integration 
techniques  limit  the  success  of  this  technique.  Nonetheless,  accelerometric  compensation 
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Figure  5.5:  Block  Diagram  of  Acceleration  Compensation  Model 

was  pursued  as  a  method  of  improving  the  relative  straight  line  motion  quality  of  the 
robot. 

By  attaching  an  accelerometer  to  the  end  effector  in  the  direction  normal  to  the  de- 
sired motion  of  the  tool,  the  normal  position  of  the  tool  could  be  estimated.  With  this 
displacement  estimate,  corrective  motions  could  be  commanded  to  a  compensation  mech- 
anism. The  compensation  could  occur  internally  as  resolved  displacements  in  the  joints  of 
the  robot  or  an  external  device  could  be  used  to  produce  required  displacement.  For  this 
application,  the  high  speed  and  high  resolution  external  compensator  was  used. 

To  demonstrate  its  capabilities,  the  accelerometric  compensation  technique  was  first 
simulated  with  an  ACSL  program,  using  the  dynamic  model  of  the  external  compensator 
described  earlier.  A  schematic  representation  of  the  compensator  and  servo  can  be  seen  in 
Figure  5.5.  The  simulated  response  of  the  system  matched  the  actual  servo  system  quite 
well.  Step  inputs  were  commanded  to  both  the  simulated  model  and  the  actual  servo  and 
the  responses  were  nearly  identical.  The  accurate  model  allows  the  response  of  the  system 
to  be  accurately  tested  using  various  compensation  techniques. 

The  simulations  introduced  perturbations  to  the  system  as  steps  in  acceleration.  With- 
out compensation,  this  resulted  in  displacements  of  +/-  0.015  inch  (0.38  mm).  These  dis- 
placements correspond  to  the  displacements  due  to  the  poor  straight  line  motions  observed 
in  Figure  [4.27]. 
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Figure  5.6:  Simulation  of  Accelerometric  Compensation  Using  Ideal  Integrators 

The  first  simulation,  seen  in  Figure  5.6  was  performed  using  ideal  integrators,  1/s  in 
the  s  domain.  The  compensation  completely  eliminated  all  traces  of  the  positional  errors 
caused  by  the  step  perturbations  in  accelerations.  The  response  was  perfect  as  expected, 
because  the  ideal  double  integration  provided  exact  knowledge  of  the  positional  errors  and 
the  external  servo  was  able  to  respond  quickly  enough  to  eliminate  these  errors. 

The  simulation  was  repeated  using  more  realistic  integrators.  These  integrators  in- 
cluded a  variable  time  constant.  Again  in  the  s  domain  the  integrator  can  be  described 
by  the  following  equation: 

n        K 

(5.3) 


O 
I 


l  +  Ts 


where 

0  -  is  the  output 

/  -  is  the  input 

K  -  is  the  proportional  gain 

T  -  is  the  integral  time  constant 

Both  K  and  T  are  variables,  where  the  integral  time  constant  adjusts  the  control 
action.  The  inverse  of  the  integral  time  T  is  called  the  reset  rate  and  is  related  to  the 
number  of  times  that  the  proportional  part  of  the  control  action  is  duplicated  over  a 
discrete  time  interval,  [63].  By  setting  the  time  constant  equal  to  one  second  for  the  next 
simulation,  the  control  action  is  duplicated  only  one  time  per  second.  This  results  in  a 
rather  poor  compensation  as  seen  in  Figure  5.7. 
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Figure  5.7:  Simulation  of  Accelerometric  Compensation  Using  an  Integrator  with  a  One 
Second  Time  Constant 
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Figure  5.8:  Simulation  of  Accelerometric  Compensation  Using  an  Integrator  With  a  Ten 
Second  Time  Constant 

A  third  simulation  was  performed,  and  in  this  instance  the  integral  time  constant 
was  set  equal  to  10  seconds.  The  result  as  seen  in  Figure  5.8.  provides  nearly  perfect 
compensation.  The  improvement  over  the  previous  simulation  is  due  to  the  increased 
time  constant,  as  the  resulting  reset  rate  increased  to  10  times  per  second. 

As  mentioned  previously,  the  perturbation  steps  in  acceleration,  when  integrated  twice 
produce  those  trapezoidal  shapes  in  displacement  which  were  superimposed  on  the  tool 
displacement  paths  seen  in  Figures  5.6  through  5.8.  The  overshoot  at  the  beginning  of 
the  simulation  demonstrates  the  step  response  of  the  simulated  system. 

Because  the  simulation  of  this  compensation  method  using  accelerometric  feedback 
was  successful,  it  was  determined  that  it  should  be  developed  and  implemented  on  the 
T3-776.  Accelerometric  compensation  has  several  other  advantages  in  that  it  is  a  generic 
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solution  and  can  be  adapted  to  other  robots,  most  of  the  necessary  components  were 
already  developed  and  working,  and  this  method  could  be  implemented  at  a  reasonable 
cost. 

Development  of  an  Accelerometric  Compensation  Scheme 

In  this  section,  the  development  of  an  accelerometric  compensation  scheme  will  be  dis- 
cussed, including  the  design  and  testing  of  various  analog  integration  circuits.  Both  analog 
and  digital  integration  techniques  were  investigated.  It  was  decided  that  an  analog  circuit 
would  be  developed  to  provide  the  integrations  needed  for  the  compensation  technique. 
At  the  time,  analog  integration  circuits  appeared  to  be  simple  to  build  and  implement. 

An  example  of  the  problems  associated  with  digital  integration  techniques  will  be 
presented  here.  Both  the  trapezoidal  rule  and  rectangle  integration  methods  were  used  in 
the  simulation  programs  described  previously  with  excellent  results.  These  methods  are 
in  fact  recommended  for  infinite  intervals  of  integration  [64].  The  excellent  results  of  the 
simulation  can  be  attributed  to  ideal  input  variables  with  zero  DC  offset.  However,  when  a 
small  DC  bias  was  applied  to  the  simulated  accelerometer  output,  the  system  would  soon 
saturate  and  the  estimated  position  would  'run  away'.  Thus  designs  for  analog  integrators 
were  developed. 

To  produce  design  parameters  for  the  analog  integration  system,  an  accurate  repre- 
sentation of  the  poor  straight  line  motion  of  the  robot  was  necessary.  The  model  was 
generated  by  commanding  the  robot  to  produce  a  straight  line  motion  along  an  arbitrary 
straight  path.  For  one  particular  experiment,  the  robot  was  commanded  to  repeat  a 
straight  line  motion  parallel  to  the  Global  Y  axis,  with  the  robot  in  a  somewhat  retracted 
configuration  and  a  commanded  velocity  of  0.5  inch/second  (12.5  mm/second). 
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Position  of  End  Effector  For  Retracted  Configuration 

Position  (inches) Orientation  (degrees) 

X  34.32  D  180 

Y     -9.20  to  7.46     E  0 

Z  14.74  R  0 


A  seismic  accelerometer  and  a  capacitive  displacement  probe  were  rigidly  attached 
to  the  end  effector  of  the  robot.  The  accelerometer  and  displacement  probe  were  located 
parallel  to  each  other  and  normal  to  the  desired  trajectory  of  the  end  effector.  A  large-right 
angle  mounting  plate  with  machined  surfaces  was  placed  parallel  to  the  desired  trajectory 
of  the  end  effector  and  within  the  operating  range  of  the  capacitive  displacement  probe,  see 
Figure  5.9.  Both  the  output  of  the  accelerometer  and  capacitance  probe  were  recorded  on 
a  real  time  data  logger  and  the  results  for  a  32  second  duration  are  shown  in  Figure  5.10. 
To  reveal  a  more  detailed  description  of  the  motion  and  accelerations,  the  time  scale  of 
the  previous  figure  was  expanded,  where  the  complete  graph  covers  the  motion  during  a 
one  second  time  interval,  in  Figure  5.11. 

Observing  Figures  5.10  and  5.11,  a  range  of  interest  in  the  frequency  domain  spans  from 
0.1  Hz  to  approximately  30  Hz.  With  this  information,  design  criteria  for  the  integrators 
was  established.  From  previous  work  with  integrators,  it  was  obvious  that  DC  noise  at  the 
input  had  to  be  eliminated  so  that  the  integrators  would  not  saturate  over  an  extended 
period  of  time. 

Thus,  the  first  generation  integrators  were  designed  to  incorporate  a  high  pass  filter, 
which  would  attenuate  the  DC  components  by  using  a  corner  frequency,  Fc,  of  0.1  Hz. 
Figure  5.12  is  the  schematic  for  the  integrator  and  high  pass  filter  built.  It  should  be  noted 
that  the  values  for  the  resistors  and  capacitors  were  approaching  the  limit  for  standard 
off-the-shelf  components.  These  combination  Integrator/High  Pass  Filters,  I/HPF,  were 
tested  by  introducing  a  random  noise  signal  to  the  input  and  monitoring  the  output.  The 
random  noise  was  generated  by  a  GenRad  spectrum  analyzer,  and  the  spectrum  of  the 
random  noise  was  flat  out  to  the  desired  high  end  of  the  frequency  range,  30  Hz. 
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Figure  5.9:  Method  of  Measuring  Displacement  and  Acceleration  of  End  Effector  Normal 
to  Desired  Motion 
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Figure  5.10:  Displacement  and  Acceleration  Records  of  End  Eifector  Motions  Normal  to 
Desired  Straight  Line  Path 


fiCCEL    GUT 


.  000 


-I- 


RT    INPUT    LIN 

CH    3 

3X+  I 

IN/'SEC.*« 


.000 


MfW 


m 


p 


pWll 


^ 


ii: 


W 


i r- 


32.50 
DISPLFlCEMENT 


LIN 


IMECSEC) 


23.50 


0.0la00 


RT    INPUT    LIN 

CH    1 

1X+ 

INCHES 


0.0_ 


-XT^ 


jv7v;;^5£2ZV: 


-\r 


'Xr 


22.50 
TIME(SEC):     22. 4S 


1  j  1 

LIN  TIME(SEC) 

flMPL:     -0.2940 

1  RRM?       r 


i r- 


^ 


23.50 


Figure  5.11:  Expanded  Time  Scale  of  Previous  Record,  22.5  to  23.5  Seconds 
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Figure  5.12:  Schematic  of  Initial  Integrator/High  Pass  Filter 

The  transfer  function,  in  the  form  of  a  Bode  diagram,  between  the  input  and  output 
for  two  I/HPF  in  series  was  obtained  with  the  spectrum  analyzer.  The  results  are  shown 
in  Figure  5.13.  From  the  figure  it  is  apparent  that  the  response  of  the  system  is  quite  good 
for  frequencies  of  6  Hz  or  greater,  the  slope  is  linear  and  the  phase  is  almost  constant. 
But,  frequencies  from  0.1  Hz  to  6  Hz  are  also  of  interest  and  the  slope  of  the  magnitude 
over  this  range  was  not  linear  and  the  phase  angle  was  not  constant,  causing  distortions 
in  the  desired  output  response.  The  distortions  were  caused  by  the  effects  from  the  HPF. 
Note  that  the  HPF  did  attenuate  the  low  frequency  components,  so  that  unwanted  DC 
components  would  not  cause  the  circuits  to  become  saturated  over  an  extended  period  of 
time. 

Ideally,  a  new  I/HPF  should  be  developed  with  a  similar  design,  where  the  corner 
frequency  would  be  shifted  one  decade  lower,  or  set  equal  to  0.01  Hz.  This  would  move 
the  range  of  usable  response  down  one  decade  also,  so  that  the  effective  frequency  range 
would  span  from  0.5  Hz  up.  Initially  the  proper  components  were  not  available  to  make 
the  desired  changes,  so  the  integrator/filter  was  redesigned  to  accommodate  the  necessary 
changes. 

A  new  integrator  was  designed,  specifically  a  low  noise  integrator  with  a  designed 
corner  frequency  of  0.1  Hz.  A  high  pass  filter  was  not  included  in  this  design,  but  a 
second  order  low  pass  filter  was  introduced  in  series  at  the  output  of  the  integrator.  The 
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Figure  5.13:  Transfer  Function  of  Initial  Integrator/High  Pass  Filter 

low  pass  filter  had  a  corner  frequency  of  approximately  15  Hz.  The  low  pass  filter  was 
incorporated  to  improve  the  stabiUty  of  the  external  compensation  servo  loop.  Figure  5.14 
provides  a  schematic  of  both  the  low  noise  integrator  and  the  second  order  low  pass  filter. 

The  combination  low  noise  integrator  and  low  pass  filter  was  tested  by  again  intro- 
ducing a  random  noise  input  with  a  flat  spectrum  up  to  30  Hz.  The  Bode  diagram  of  the 
transfer  function,  seen  in  Figure  5.15  shows  the  response  of  the  system.  The  magnitude 
response  is  linear  from  0.2  Hz  to  13  Hz.  The  phase  is  not  constant  over  the  same  range, 
but  it  is  approximately  constant  from  0.2  Hz  to  4  Hz.  This  does  introduce  some  distortions 
in  phase,  but  for  a  first  compensation  implementation,  this  system  appeared  acceptable. 

The  original  compensation  scheme  called  for  two  integrators  in  series,  so  that  positional 
commands  could  be  directly  sent  to  the  compensator  controller.  However,  the  double 
integrators  have  a  tendency  to  become  unstable  and  quickly  saturate  because  of  DC  bias 
voltages  at  the  input.  To  eliminate  this  problem,  a  method  which  required  only  a  single 
integrator  was  investigated. 

Looking  at  a  simplified  schematic  representation  of  the  external  servo  loop,  it  appeared 
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Figure  5.14:  Schematic  of  Low  Noise  Integrator  and  Second  Order  Low  Pass  Filter 
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Figure  5.15:  Transfer  Function  of  Low  Noise  Integrator  and  Second  Order  Low  Pass  Filter 
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that  only  one  integrator  would  be  required  if  the  compensation  signal  was  introduced 
at  the  velocity  feedback  comparator.  A  single  integration  of  an  accelerometric  output 
would  result  in  a  velocity  term  which  could  be  introduced  to  the  velocity  loop  of  the 
motor  controller.  Utilizing  a  single  integrator  would  reduce  the  chances  of  saturating  the 
compensation  circuit,  thus  improving  the  extended  operation  capabilities  of  the  system. 

Implementation  of  an  Accelerometric  Compensation  Scheme 

This  section  will  describe  the  initial  implementation  and  testing  procedures  used  for 
the  compensation  scheme.  A  simple  method  was  devised  to  accurately  set  the  gain  for  the 
compensation  servo  mechanism.  The  calibration  involved  mounting  a'horizontal  cantilever 
beam  with  an  adjustable  mass  to  a  rigid  support.  An  accelerometer  was  mounted  to  the 
free  end  of  the  cantilever  beam,  see  Figure  5.16.  When  the  cantilever  beam  is  excited, 
it  produces  a  lowly  damped  sinusoidal  output.  Sinusoids  are  an  excellent  benchmark  in 
determining  the  response  of  a  servo  system  and  are  easily  identifiable  in  real  time  data 
loggers  (oscilloscopes,  strip  chart  recorders,  data  analyzers).  The  output  charge  of  the 
accelerometer  is  sent  to  a  chai-ge  amplifier  and  the  amplifier  output  is  then  used  as  the  input 
to  the  compensation  circuit.  In  addition  to  the  accelerometer,  a  capacitive  displacement 
probe  was  mounted  near  the  end  of  the  cantilever  beam  so  that  the  displacement  of  the 
beam  could  be  accurately  monitored. 

Another  capacitive  displacement  probe  was  located  on  the  end  of  the  compensation 
servo  slide  mechanism,  see  Figure  5.16.  This  displacement  probe  would  measure  the 
displacement  of  the  compensator  table  in  relation  to  a  fixed  reference.  This  would  provide 
a  direct  reading  of  the  response  of  the  positional  servo  loop  and  allow  a  comparison 
between  the  motion  of  the  cantilever  beam,  as  an  input  to  the  compensation  system,  and 
the  motion  of  the  slide  mechanism,  as  the  output  of  the  compensation  system.  In  addition, 
this  would  enable  the  compensation  positional  loop  gain  to  be  set  accurately. 

Thus  an  uncoupled  calibration  method  was  developed.  The  system  would  run  open 
loop  and  some  of  the  inherent  stability  problems  would  be  eliminated.    The  output  of 
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Figure  5.16:  Calibration  Set-Up  For  the  Accelerometric  Compensator 
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Figure  5.17:  Displacement  Record  of  Cantilever  Beam  and  Compensation  Servo  -  4  Hz 

both  displacement  probes,  along  with  the  output  of  the  accelerometer,  were  monitored 
and  recorded  by  the  GenRad.  Initially  problems  were  observed  with  the  system  when 
the  compensator  and  the  GenRad  were  both  monitoring  the  output  of  the  accelerometer. 
The  problem  was  finally  traced  to  the  low  impedance  of  the  input  of  the  GenRad  data 
analyzer.  After  this  problem  was  corrected,  all  three  data  signals  could  be  recorded  while 
the  compensator  was  operational. 

The  mass  was  adjusted  on  the  cantilever  beam  so  that  when  the  beam  was  excited, 
the  first  mode  of  vibration  occurred  at  4  Hz.  With  the  both  displacement  probes  being 
displayed  real  time  on  the  screen  of  the  GenRad,  the  gain  of  the  compensation  circuit 
could  be  adjusted  so  that  the  displacement  of  the  compensation  slide  would  be  equal  to 
the  displacement  of  the  free  end  of  the  cantilever  beam,  (where  the  accelerometer  was 
located).  The  top  of  Figure  5.17  depicts  the  measured  displacement  of  the  cantilever 
beam.  The  corresponding  displacement  of  the  slide  table  is  shown  at  the  bottom  of 
Figure  5.17.  Note  that  the  input  for  the  servo  driven  slide  table  is  the  integrated  output 
of  the  accelerometer  mounted  on  the  end  of  the  cantilever  beam.    The  'smooth'  section 
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Figure  5.18:  Displacement  Record  of  Cantilever  Beam  and  Compensation  Servo  -  2  Hz 


seen  around  the  2.0  second  mark  was  caused  by  physically  grabbing  the  cantilever  for 
a  moment  and  then  re-exciting  the  cantilever  beam.  This  was  done  to  demonstrate  the 
response  of  the  system  to  a  non-sinusoidal  input. 

It  should  be  noted  that  the  displacement  of  the  slide  is  shifted  downward  by  a  constant 
value  and  this  effect  is  attributed  to  DC  drifts  in  the  compensation  circuit.  Remember 
that  a  high  pass  filter  was  not  incorporated  into  this  compensation  circuit,  allowing  DC 
components  to  cause  problems  such  as  this.  Overall,  it  appeared  that  this  compensation 
method  was  quite  good  for  the  4  Hz  excitation. 

This  experiment  was  repeated  for  a  different  sinusoidal  frequency.  The  natural  fre- 
quency of  the  cantilever  beam  was  reduced  to  approximately  2  Hz  by  adding  additional 
mass  to  the  cantilever  beam.  The  beam  was  excited,  and  again  the  displacements  at  both 
the  end  of  the  beam  and  the  compensation  slide  were  monitored  and  recorded,  the  top 
and  bottom  of  Figure  5.18  respectively.  The  magnitude  of  the  displacement  was  correct, 
but  the  phase  was  retarded  by  approximately  45  degrees.  The  phase  shift  would  cause 
very  poor  compensation,  so  the  cause  of  this  phase  shift  was  investigated. 
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Looking  back  at  the  transfer  function  of  the  combination  integrator/low  pass  filter 
in  Figure  5.15  a  phase  change  of  approximately  45  degrees  at  2  Hz  is  evident.  The 
somewhat  poor  phase  characteristics  of  this  circuit  was  traced  to  the  low  pass  filter  which 
was  introduced  to  improve  the  stability  of  the  system.  The  low  pass  filter  was  then 
removed  from  the  circuit  and  the  experiment  was  repeated.  The  results  were  favorable, 
with  minimal  phase  shift  and  proper  magnitude  for  the  compensatory  displacement. 

The  feedback  accelerometer  was  then  moved  from  the  cantilever  beam  to  the  compen- 
sator. The  accelerometer  was  located  parallel  to  the  prismatic  axis  of  the  compensator, 
thus  only  motions  normal  to  the  desired  trajectory  of  the  tool  path  would  be  detected  by 
the  accelerometer.  With  the  accelerometer  rigidly  attached  to  the  frame  of  the  external 
compensator,  the  positional  loop  of  the  compensator  was  closed.  Remember  that  when 
the  accelerometer  was  located  on  the  cantilever  beaiA,  the  system  was  operating  in  an 
open  loop  fashion. 

The  capacitance  probe  which  was  rigidly  attached  to  the  slide  of  the  external  compen- 
sator measured  the  displacement  of  the  slide  with  reference  to  the  fixed  right-angle  bracket 
as  described  earlier.  The  end  effector  of  the  robot  was  excited  by  commanding  the  robot 
to  move  along  a  desired  straight  line  path  with  a  constant  velocity.  During  the  motion, 
the  displacements  and  their  resulting  accelerations  in  the  normal  direction  provided  an 
input  to  the  compensator.  This  provided  a  method  to  evaluate  the  closed  response  of  the 
compensator.  However,  the  system  became  unstable  and  quickly  caused  the  servomotor 
of  the  external  compensator  to  accelerate  to  its  maximum  velocity  and  continue  to  rotate 
at  that  speed  until  it  was  manually  disabled. 

To  determine  the  cause  of  this  instability,  the  output  of  the  accelerometer  was  directed 
to  the  GenRad  dynamic  analyzer,  the  compensation  servo  and  robot  servos  were  deacti- 
vated, and  the  end  effector  of  the  robot  was  struck  with  a  rubber  mallet.  The  resulting 
output  revealed  a  dominant  23.5  Hz  natural  frequency  of  the  compensator  when  mounted 
on  the  robot.  This  natural  frequency  was  somewhat  position  independent,  in  that  the 
test  was  repeated  in  several  different  configurations  and  the  natural  frequency  remained 
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Figure  5.19:  Effect  of  Notch  Filter  in  Reducing  Natural  Frequency  Component  at  23.5  Hz 

within  a  +/-  0.5  Hz  range  of  23.5  Hz.  A  notch  filter  was  designed  and  built  to  eliminate 
the  effects  of  this  system's  natural  frequency.  The  top  of  Figure  5.19  shows  the  response 
of  the  end  effector  after  being  struck.  The  tuned  notch  filter  was  then  used  to  eliminate 
the  dominant  natural  frequency  and  the  result  can  be  seen  in  the  bottom  of  Figure  5.19. 
The  notch  filter  completely  eliminates  the  effects  of  23.5  Hz  frequency. 

The  notch  filter  was  then  connected  serially  to  the  input  of  the  existing  low  noise 
integrator  described  earlier.  The  transfer  function  for  this  combination  of  notch  filter  and 
integrator  can  be  seen  in  Figure  5.20.  Note  the  excellent  phase  response,  almost  constant 
over  the  frequency  range  between  0.5  and  15  Hz.  The  system  was  then  tested,  where  the 
end  effector  was  excited  by  a  blow  from  the  rubber  mallet.  The  closed  loop  system  did 
not  become  unstable,  but  little  improvement  from  the  compensator  was  evident,  as  the 
record  of  the  compensated  straight  line  motion  revealed  deviations  from  the  desired  path 
of  up  to  +/-  0.008  inch  (0.203  mm). 

The  accelerometer  was  moved  from  the  compensator  back  to  the  cantilever  beam  in 
hopes  of  identifying  the  causes  for  the  lack  of  improvement  when  using  the  compensator. 
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Figure  5.20:  Transfer  Function  of  Low  Noise  Integrator  and  Notch  Filter 


With  the  open  loop  control  reinstated,  the  gains  for  the  compensator  could  be  rechecked 
and  adjusted  if  necessary.  The  cantilever  beam  had  weights  attached  which  would  produce 
a  2  Hz  natural  frequency  when  excited.  The  displacements  of  both  the  cantilever  beam 
and  the  slide  of  the  compensator  were  again  recorded,  see  Figure  5.21.  The  magnitude  of 
the  displacement  was  correct,  but  there  was  a  phase  shift  of  approximately  90  degrees. 

The  cause  of  this  phase  shift  was  not  immediately  apparent.  Then,  realizing  that  an 
additional  integrator  would  provide  the  needed  90  degree  phase  shift,  the  equations  of 
the  servo  control  loop  were  re-investigated.  A  simplified  block  diagram  of  the  position 
controlled  servomotor  with  accelerometric  compensation  is  presented  in  Figure  5.22.  The 
transfer  function  for  the  system  is  written  as: 

S^  -[■  KyKrriHvS  +  KpKyKm 

where 

Xa{s)  -  actual  position  of  device 
Kp  -  positional  gain  of  servo 
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Figure  5.21:  Open  Loop  Response  of  Compensator  with  Single  Integrator  and  Notch  Filter 
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Ky  -  velocity  gain  of  servo 

K-rn  -  gain  of  servo  motor 

Ki  -  double  integrator  gain 

K2  -  single  integrator  gain 

Hy  -  tachometer  feedback  gain 

Xdis)  -  desired  position  of  compensator 

Ae{s)  -  acceleration  of  the  displacement  error,  Pg 

The  second  term  in  the  numerator  is  from  the  double  integrator  and  is  inserted  at  the 
summing  junction  of  the  positional  loop.  The  third  term  in  the  numerator  is  from  the 
single  integrator  and  is  introduced  to  the  velocity  loop  of  the  controller.  The  acceleration 
of  a  displacement  error  can  be  represented  by  the  following  equation: 

A,{s)  =  Xe{s)  *  s^  (5.5) 

where 

Ae{s)  -  acceleration  of  the  displacement  error  in  the  normal  direction 
Xe{s)  -  positional  error  in  the  's'  domain 

Now,  if  the  expression  for  Ae{s)  from  Equation  5.5  is  substituted  into  Equation  5.4 
and  simplified,  one  obtains: 

Y  (,.       iI^VivKm)Xd{s)  +  {KxK^KyK^)X,{s)  +  {K2KvKm)sP,{s) 

s^  +  KyR^HyS  + KphyA^ 

Observe  the  last  term  in  the  numerator,  it  is  the  term  which  was  incorporated  into  the 

accelerometric  compensation  scheme  using  the  single  integrator  at  the  velocity  loop  of  the 

servo  controller.    The  additional  's'  is  the  term  which  caused  the  90  degree  phase  shift 

seen  earlier.  Thus,  it  is  apparent  that  if  an  accelerometer  is  to  be  used  in  observing  the 

normal  positional  error,  a  double  integrator  will  be  required.    The  middle  term,  which 

includes  the  double  integrator,  has  the  same  gain  as  the  desired  position  input,  Xd-  This 

would  enable  the  servo  to  respond  to  the  errors  in  position,  X^  in  the  same  manner  as 

the  desired  input.  For  a  well  tuned  servo,  the  response  to  the  errors  in  position  should  be 

excellent.  But  the  problems  associated  with  double  integrators  remain. 
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Figure  5.23:  Transfer  Function  of  the  Improved  Integrator/High  Pass  Filter 


A  new  pair  of  integi'ators  were  designed,  built  and  tested.  Again  they  incorporated 
low  noise  integrators  with  high  pass  filters,  but  this  time  the  corner  frequency  was  shifted 
to  0.05  Hz.  This  was  accomplished  by  experimenting  with  several  types  of  capacitors  and 
by  arranging  them  in  various  combinations,  the  corner  frequency  was  shifted  one  decade 
lower  from  the  previous  0.5  Hz  (as  seen  in  Figure  5.13).  The  response  of  the  integrator 
was  quite  good.  There  was  little  phase  shift  encountered  above  0.5  Hz,  and  the  magnitude 
response  was  linear  down  to  0.3  Hz,  see  Figure  5.23. 

Even  with  the  high  pass  filter  attenuating  the  DC  components,  an  input  voltage  bias 
circuit  had  to  be  included  to  help  reduce  the  chance  of  saturating  the  integrator.  Because 
integrators  are  basically  low  pass  filters,  the  output  from  these  devices  are  also  attenuated. 
To  amplify  the  output  of  these  circuits  to  the  level  as  required  by  the  compensation  servo 
amplifier,  additional  op-amp  circuits  were  introduced  in  series  as  lOX  amplifiers.  Both 
integrators  had  to  be  'tuned'  individually,  that  is,  the  potentiometer  which  controlled  the 
bias  voltage  had  to  be  carefully  adjusted.  The  DC  component  could  be  reduced  to  less 
than  a  millivolt  when  the  input  to  the  circuit  was  grounded. 
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Figure  5.24:  Transfer  Function  of  Improved  Double  Integrator  Circuit 


A  transfer  function  of  tlie  double  integrator  circuit  incorporating  high  pass  filters,  lOX 
amplifiers  and  bias  voltage  circuits  was  produced  by  introducing  a  random  noise  signal  to 
the  input  and  monitoring  both  the  input  and  the  output  of  the  circuit  with  the  GenRad. 
This  can  be  seen  in  Figure  5.24.  The  excellent  response  of  the  double  integrator  circuit  is 
due  to  the  ideal  conditions  during  the  experiment.  The  noise  generator  used  to  produce 
the  input  signal  to  the  integrator  produced  zero  DC  bias  voltage,  which  reduced  the 
chances  of  saturation  and  allowed  the  sampling  to  continue  over  a  period  of  30  seconds. 
The  operational  frequency  range  was  useful  down  to  approximately  0.6  Hz.  At  frequencies 
below  0.6  Hz,  the  phase  shift  starts  to  introduce  errors  to  the  system.  Even  though  the 
corner  frequency  of  the  circuit  was  forced  down  to  0.05  Hz,  the  useable  range  was  reduced 
because  of  the  physical  properties  of  the  components.  The  'noise'  in  the  transfer  function 
of  frequencies  higher  than  5  Hz  is  due  to  signal  to  noise  level  being  reduced  at  40  db  per 
decade  due  to  the  attenuation  from  the  integrators. 

At  this  point,  the  output  of  the  accelerometer  attached  to  the  cantilever  beam  was 
directed  to  the  input  of  the  double  integration  circuit.  The  beam  was  excited  and  oscillated 
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Figure  5.25:  Schematic  of  Double  Integrator  Circuit 

at  its  natural  frequency  of  2  Hz.  Within  2  seconds,  the  circuit  was  saturated  at  12 
volts,  the  supply  voltage.  The  input  of  the  circuit  was  again  grounded  and  the  bias 
voltage  circuits  individually  adjusted  so  that  the  circuit  was  stable  and  had  an  output  of 
approximately  zero  volts.  The  accelerometer  was  reattached  and  the  beam  was  excited. 
Almost  immediately,  the  circuit  was  saturated  again.  This  process  was  repeated  several 
times,  with  minor  modifications  made  to  the  circuit,  but  the  result  was  the  same.  The 
circuit  would  consistently  saturate  within  5  seconds. 

It  should  be  noted  that  the  double  integrator  circuit  approached  the  limits  of  normal 
circuit  components.  The  design  of  the  circuit  meets  the  original  requirements  of  the  in- 
tegrator established  at  the  beginning  of  the  experiment,  wide  bandwidth,  low  frequency 
response,  DC  attenuation,  and  low  frequency  distortion  in  the  required  bandwidth.  How- 
ever, when  the  circuit  was  connected  to  the  accelerometer,  the  circuit  would  continue  to 
saturate.  The  cause  of  this  DC  bias  in  the  accelerometer  is  unknown,  but  perhaps  it  could 
be  traced  and  eliminated. 

A  final  double  integration  technique  was  tested,  a  double  integrator  on  a  single  chip. 
By  utilizing  this  technique,  it  was  thought  that  the  problems  associated  with  input  DC 
bias  voltages  and  saturation  would  be  reduced.   Figure  5.25  shows  the  schematic  of  the 
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double  integrator.  Reducing  the  circuit,  the  following  transfer  function  can  be  derived: 

Setting  R  —  Imfi  and  C  —  0.5/iF,  the  corner  frequencies  are  equal  to  0.5  Hz.  Again,  this 
corner  frequency  is  approximately  a  decade  too  high,  but  this  is  a  good  starting  point.  The 
circuit  was  assembled,  and  a  precision  low  noise  op-amp  was  used.  The  input  was  grounded 
and  the  circuit  activated.  Almost  immediately,  the  output  was  saturated.  Several  other 
modifications  were  made  to  the  circuit  with  no  improvement.  Out  of  curiosity,  the  values 
of  R  and  C  were  experimented  with.  When  the  values  for  R  and  C  were  chosen  so  that 
the  corner  frequencies  equaled  10  Hz,  the  system  functioned  as  desired;  however,  this 
frequency  was  much  higher  than  required. 

The  analog  system  is  limited  by  the  corner  frequency  of  the  integrator.  For  the  purposes 
of  compensation,  the  corner  frequency  must  be  low;  however,  saturation  occurs  at  these 
low  frequencies.  It  is  apparent  that  either  a  much  more  elaborate  analog  integration  circuit 
is  required,  or  that  a  dedicated  digital  system  should  be  developed. 

Accelerometric  Compensation  Conclusions 

In  theory,  compensation  of  straight  line  motion  errors  using  accelerometric  techniques 
appears  to  be  a  straight  forward,  easily  implementable  task.  Simply  by  double  integrating 
the  output  of  an  accelerometer,  the  positional  error  information  is  recovered.  However, 
in  the  practical  sense,  double  integration  of  the  accelerometer  signals  is  a  difficult  task, 
because  of  the  low  frequencies  involved. 

In  the  early  1960's,  eloquent  analog  integration  techniques  were  developed  for  shock 
and  vibration  analysis.  They  reached  similar  limitations  to  what  was  encountered  by  the 
research  described  previously.  The  integrators  were  limited  to  short  durations  (less  than 
one  second)  for  real  time  analysis,  and  for  extended  duration  requirements,  non  real  time 
operation  was  imposed,  [62].  These  systems  incorporated  high  pass  filters  to  eliminate  the 
saturation  effects  due  to  DC  contamination,  thus  the  low  frequency  signals  (below  10  Hz) 
were  attenuated  or  distorted. 
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The  requirements  for  accelerometric  compensation  of  the  industrial  robot  are  quite 
difficult  to  meet  because  they  include: 

•  real  time  operation 

•  wide  dynamic  range  (0.5  Hz  to  30  Hz) 

•  able  to  operate  near  DC 

•  produce  low  phase  distortion 

At  this  point  in  time,  it  is  apparent  that  a  different  type  of  integrator  should  be 
produced.  There  are  basically  two  choices,  either  develop  a  more  sophisticated  analog 
circuit  or  design  a  digital  integrating  device.  The  analog  integrator  circuit  developed  by 
Oleson  [62]  might  be  adequate  for  a  prototype  design.  The  integrator  described  by  Oleson 
incorporates  a  very  stable  voltage  controlled  oscillator  supplying  a  series  of  fixed  charges 
to  an  integrating  capacitor.  The  long  time  average  of  the  capacitor  voltage  is  held  at  zero 
by  a  feedback  circuit.  Perhaps  twenty  year  old  technology  could  be  re-introduced  to  solve 
a  modern  problem. 

Another  method  would  require  the  development  of  a  digital  integrator.  Similar  prob- 
lems analogous  to  the  saturation  problem  in  the  analog  circuit  might  be  eliminated  by 
incorporating  the  proper  digital  filtering  techniques.  The  digital  filtering  technology  has 
to  be  studied  further  before  a  successful  system  can  be  developed. 

Once  the  proper  positional  command  is  obtained,  whether  it  be  from  analog  or  digital 
methods  (or  a  combination  of  both),  it  appears  that  the  external  compensator  performs 
quite  well  as  seen  in  Figures  5.17  and  5.18.  The  results  of  direct  displacement  feedback 
also  demonstrates  the  capability  of  the  external  compensator.  Once  the  positional  error  is 
provided,  the  compensator  can  effectively  eliminate  the  normal  errors  of  the  tool  trajectory. 
By  concentrating  efforts  on  developing  a  double  integration  technique  which  effectively 
provides  the  necessary  error  displacement  input,  this  method  of  improving  straight  line 
motion  or  smooth  motion  should  be  successful. 

To  improve  the  smooth  motion  capabilities  of  the  robot,  the  resultant  accelerations 
due  to  a  desired  change  in  direction  must  be  kept  under  the  corner  frequency  of  the  system 
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integrators.  Otherwise,  the  accelerations  due  to  changes  in  tlie  normal  tool  direction  will 
have  adverse  effects  on  the  position  of  the  tool.  For  straight  line  motions  this  is  not  a 
concern,  because  any  accelerations  detected  in  the  normal  direction  indicate  a  path  error 
at  the  tool. 


CHAPTER  6 
SUMMARY  AND  CONCLUSION 


The  need  of  improving  the  motion  capabilities  of  robots  is  evident  in  the  number  of 
difficult  tasks  that  industrial  robots  are  now  required  to  perform.  In  many  of  these  new 
applications,  the  performance  requirements  may  exceed  the  capabilities  of  the  robot.  For 
example,  precision  machining  applications  require  the  position  of  the  tool  be  accurately 
controlled  and  currently  this  is  accomplished  by  using  rigid  templates  to  guide  the  robot 
over  the  necessary  path.  A  different  template  must  be  manufactured  for  each  different  type 
of  part.  These  templates,  while  providing  absolute  positioning  capabilities  for  the  robot, 
are  expensive  to  produce  and  limit  the  flexible  manufacturing  capabilities  of  the  robot. 
To  increase  the  economy  of  the  robots  in  precision  machining  applications,  rigid  templates 
should  be  eliminated  and  be  replaced  by  alternate  compensation  methods.  Several  prac- 
tical methods  have  been  presented  which  help  to  improve  the  motion  capabilities  of  an 
existing  industrial  robot  including:  dynamic  compensation  for  changes  in  load  torques, 
flexibility  compensation  of  the  robot  structure,  and  accelerometric  compensation  to  im- 
prove the  straight  line  motion  capabilities  of  the  robot. 

Most  robots  provide  reasonably  good  repeatability,  which  is  related  to  the  relative 
accuracy  of  the  robot.  The  Cincinnati  Milacron  T3-776  for  example  has  a  stated  repeata- 
bility of  -I-/-0.010  inch  (0.25  mm)  through  out  a  1000  cubic  foot  (8.63  cubic  m)  work 
volume.  To  take  advantage  of  the  repeatability  of  the  robot  motion,  the  motions  of  the 
robot  are  typically  taught  on-line  with  teach  pendants.  However,  the  repeatability  is  af- 
fected if  external  influences  occur,  ie.  forces  applied  to  the  end  effector  cause  the  tool  to 
be  displaced  more  than  the  stated  repeatabihty. 

Many  modern  CADCAM  tools  provide  not  only  a  design  environment,  but  provide 
tool  coordinates  for  Computer  Numerical  Controlled  (CNC)  machine  tools  as  well.  This 
allows  the  tool  path  to  be  developed  off-line  and  transmitted  to  the  machine  tool  without 
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having  to  be  taught  manually.  For  many  CNC  machine  tools  this  method  of  developing  the 
tool  path  off-line  is  completely  satisfactory,  because  the  absolute  positioning  capabilities 
of  these  machines  are  within  the  design  specifications  of  the  component  to  be  machined, 
on  the  order  of  0.0001  inch  (0.0025  mm). 

However,  for  some  large  or  complex  three  dimensional  components,  the  traditional 
CNC  machines  lack  the  reach  or  dexterity  to  perform  the  required  machining  operation. 
Thus,  robots  might  be  substituted  for  these  difficult  applications.  Ideally,  manufacturers 
wish  to  utilize  robots  in  a  similar  manner  as  traditional  machine  tools,  including  the  off- 
line generation  of  tool  coordinates.  However,  as  mentioned  previously,  the  repeatability 
of  the  robot  is  approximately  two  orders  of  magnitude  worse  than  traditional  machine 
tools.  The  absolute  accuracy  of  robots  is  worse.  It  is  evident  that  the  motion  quality  of 
the  robot  has  to  be  improved.  Thus  factors  which  produce  errors  must  be  identified  and 
corrected. 

Typical  error  sources  are  listed  in  the  following  table  with  the  categories  in  a  somewhat 
descending  order  of  importance.  Note  that  these  sources  of  error  are  general  and  may  not 
apply  to  every  robot  or  application.  Asterisks  are  used  to  denote  the  error  sources. 

Robot  Error  Sources  As  Related 
To  Various  Modes  Of  Operation 


Sources 

Point 

Path 

of  Error 

Absolute 

Relative 

Absolute 

Relative 

Flexiblity 

* 

+ 

+ 

* 

Dynamic 

+ 

* 

Geometry 

* 

* 

Sensor 

* 

* 

* 

* 

Computation 

+ 

* 

+ 

Environment 

+ 

+ 

+ 

* 

Point  describes  the  position  and  orientation  of  a  single  point  in  the  robot  workspace, 
where  path  describes  a  trajectory  which  the  robot  is  programmed  to  follow.  Absolute 
refers  to  the  absolute  position  of  the  robot  in  the  robot's  global  coordinate  system,  and 
relative  denotes  any  frame  of  reference  in  the  robots  workspace.  Accuracy  in  the  absolute 
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positioning  of  the  robot  is  required  for  robots  whicli  are  taught  off-line.  The  relative  accu- 
racy is  easier  to  meet,  because  the  robot  is  usually  taught  on-line  with  a  teach  pendent  for 
these  applications.  FlexibiUty  deals  with  the  flexibility  of  the  structure,  Dynamic  involves 
the  dynamic  response  of  the  system,  Geometry  deals  with  the  errors  in  the  kinematic 
equations  of  motion.  Sensor  deals  with  errors  introduced  by  the  sensors,  Compututation 
deals  with  path  errors  due  to  computational  roundoff  and  Environment  is  related  to  the 
impacts  of  environment  on  the  robot  accuracy,  such  as  temperature  and  humidity. 

For  the  particular  application  of  robot  edge  milling,  relative  path  accuracy  was  deter- 
mined to  be  the  major  concern.  The  errors  due  to  flexibility  were  modeled  and  compen- 
sated for,  and  a  dynamic  compensation  technique  was  developed  and  successfully  demon- 
strated. The  errors  due  to  sensors,  computer  round  off  and  interpolation,  and  environmen- 
tal factors  were  lumped  into  a  single  compensation  technique,  improving  the  straight  line 
motion  of  the  robot.  Accelerometric  compensation  techniques  were  pursued  to  improve 
the  straight  line  performance  of  the  robot,  but  they  were  not  entirely  successful. 

Absolute  path  accuracy  will  become  more  important  as  oiT-line  programming  tech- 
niques are  implemented  more  often.  The  major  factors  which  currently  affect  the  absolute 
accuracy  of  the  robot  include:  deflection  of  the  robot  structure  under  applied  loads,  geo- 
metric errors  due  to  differences  between  the  actual  kinematic  description  of  the  robot  and 
the  kinematic  model  used  to  drive  the  robot  and  errors  of  motion  due  to  ignored  dynamic 
influence  coefficients  of  motion  in  the  robot  controller.  It  is  apparent  that  these  three 
factors  compose  a  majority  of  the  errors  in  motion  of  the  robot.  By  eliminating  these 
particular  errors,  it  may  be  possible  to  increase  the  absolute  accuracy  to  within  the  rated 
repeatabiUty  of  the  robot.  For  many  applications,  this  will  provide  sufficient  accuracy  to 
meet  the  design  speciflcations. 

When  this  work  was  originally  undertaken,  errors  due  to  structural  flexibilities  and  the 
poor  dynamic  response  of  the  robot  appeared  to  be  the  most  influential  factors.  While  the 
particular  task  of  measuring  the  geometric  errors  directly  was  not  undertaken,  methods  to 
improve  the  dynamic  response  of  the  system  and  reduce  errors  due  to  structural  flexibilities 
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were  accomplished. 

In  the  second  chapter,  several  dynamic  control  methods  and  compensation  schemes 
were  discussed.  An  innovative  direct  dynamic  compensation  scheme  developed  by  Van 
Brussel  was  modified  so.  that  it  could  be  implemented  on  an  existing  robot  without  making 
major  modifications  to  the  robot  or  its  controller.  The  observed  dynamic  compensation 
scheme  was  simulated,  developed  and  successfully  implemented  on  the  base  axis  of  the 
T3-776  robot.  The  base  was  chosen  because  the  inertial  load  at  the  base  may  change  in 
a  ratio  of  12:1  depending  on  the  configuration  of  the  robot.  The  scheme  did  improve  the 
response  of  the  system  somewhat,  but  with  the  large  gear  reduction  used  in  the  base,  the 
effect  of  the  improvement  on  the  base  was  limited. 

However,  for  robots  with  low  gear  reductions,  or  direct  drive  robots,  this  method  of 
dynamic  compensation  would  be  useful  and  practical  for  several  reasons.  The  observed 
compensation  method  does  not  require  a  detailed  dynamic  model  of  the  robot,  eliminating 
the  need  of  a  dedicated  computer  to  calculate  the  influence  coefBcients  of  the  dynamic 
equation  of  motion.  Additionally,  strain  gauges  or  other  force/torque  measuring  devices 
are  not  required  for  each  link  of  the  robot,  as  they  would  be  in  direct  dynamic  compensa- 
tion. 

For  linear  or  easily  modeled  motor  controllers,  the  observed  compensator  may  be  a  sim- 
ple analog  circuit.  For  more  complex  motor  controllers,  a  digital  or  hybrid  analog/digital 
controller  might  be  used  instead.  By  increasing  the  accuracy  of  the  model  of  the  motor  and 
controller  in  the  compensator,  the  effects  of  external  load  perturbations  can  be  eliminated 
with  greater  precision.  Models  of  permanent  magnet  DC  motors  are  quite  generic  and 
the  values  for  the  necessary  parameters  are  provided  by  the  manufacturer  or  are  obtained 
through  some  simple  modeling  techniques.  The  models  of  the  motor  controllers  are  more 
complicated.  There  are  similarities  between  various  types  of  controllers,  and  a  general 
model  of  the  controller  could  be  used  and  modified  as  required. 

The  response  of  the  motor  and  controller  was  measured  and  an  accurate  model  of  the 
base  servo  was  developed.  The  analog  circuit  of  the  compensator  used  a  simple  fijced  gain 
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amplifier  to  model  the  non-linear  motor  controller.  The  observed  compensation  scheme 
demonstrated  approximately  a  40%  improvement  over  the  same  case  without  compensa- 
tion. If  the  compensator  had  incorporated  a  more  accurate  model  of  the  controller,  an 
even  greater  improvement  may  have  been  achieved.  Additionally,  the  current  limits  of 
the  controller  reduce  the  ability  of  the  compensator  to  exactly  eliminate  all  external  dis- 
turbances. This  will  be  true  of  all  practical  dynamic  compensation  techniques  or  torque 
control  schemes,  the  ultimate  limiting  factor  is  the  peak  current  available  from  the  motor 
driver. 

As  seen  in  the  simulations,  by  providing  accurate  models  of  the  motor  and  controller  to 
the  compensator,  the  effects  of  external  torque  perturbations  can  be  completely  eliminated 
in  the  ideal  case,  or  greatly  reduced  in  the  more  realistic  simulation.  In  the  case  of  the 
T3-776  robot,  the  base  axis  incorporates  such  a  high  gear  ratio  that  the  effects  of  external 
loads  applied  to  the  end-effector  make  little  difference  to  the  response  of  the  servo. 

However  other  devices,  which  incorporate  low  gear  reductions  and  incur  large  changes 
in  load,  may  be  greatly  enhanced  by  this  compensation  method.  An  example  of  this  would 
be  the  active  table  of  a  milling  machine,  where  a  heavy  workpiece,  mounted  to  the  table 
is  machined  to  approximately  10%  of  its  original  mass.  Obviously,  the  response  of  the 
machine  would  change  as  the  mass  of  the  workpiece  changed  unless  compensation  was 
used.  For  this  and  other  robotic  applications,  it  is  felt  that  the  development  of  observed 
dynamic  compensation  should  be  pursued. 

A  hybrid  design  appears  to-be  the  most  practical,  where  the- analog  component  would 
be  used  as  the  external  load  torque  observer  and  the  servo  controller  would  be  modeled 
by  a  digital  circuit.  The  digital  portion  would  be  based  on  a  dedicated  micro-processor 
which  could  be  programmed  to  emulate  the  non-linearities  of  the  controller.  This  low 
cost  system  could  be  modified  to  operate  on  most  servo  controllers  with  minor  software 
changes.  The  hard  interfaces  would  include  current  and  velocity  inputs  from  the  motor 
and  a  voltage  output  from  the  compensator. 

The  next  area  of  concern  was  the  elimination  of  path  errors  due  to  deflections  of  the 
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robot  structure.  The  flexibility  model  of  the  robot  was  developed  by  Stern  [8].  This 
flexibility  model  was  used  to  predict  the  deflection  of  the  robot  by  actively  measuring 
the  applied  loads.  Because  the  flexibility  of  the  robot  was  position  dependent,  both  the 
position  of  the  robot  and  the  applied  forces  must  be  known  at  any  given  time  to  accurately 
calculate  the  displacement  of  the  robot.  Once  the  normal  displacement  of  the  tool  is 
calculated,  the  tool  must  be  moved  by  that  amount  to  eliminate  the  error. 

An  alternative  to  developing  the  complete  flexibility  model  of  the  structure  would  be  to 
statically  measure  the  flexibility  of  the  robot  along  the  desired  path  at  standard  intervals. 
For  an  application  where  the  displacements  are  required  for  all  six  degrees-of-freedom, 
this  would  become  an  arduous  task.  However  for  the  edge  milling  application,  only  the 
deflections  affecting  the  normal  displacement  must  be  found.  Two  forces  affect  the  normal 
displacement,  the  normal  and  tangential  cutting  forces.  The  following  equation  represents 
this  modeling  task: 

Dn  =  FLEXn*Fn  +  FLEXt*Ft  (6.1) 

The  term  Dn  represents  the  deflection  in  the  normal  direction,  FLEXn  and  FLEXt 
represent  the  normal  and  tangential  flexibilities  and  Fn  and  Ft  represent  the  normal  and 
tangential  cutting  forces.  The  flexibility  values  would  be  found  by  applying  forces  in  first 
the  normal  and  then  tangential  directions  and  measuring  the  normal  displacement  in  each 
case.  The  flexibility  values  would  be  recorded  for  each  measured  position,  and  recalled 
at  the  proper  time.  This  method  may  be  practical  only  in  instances  where  the  proper 
flexibility  modeling  knowledge  and  tools  were  missing  or  only  a  limited  number  of  tool 
paths  are  required. 

,1  There  are  three  methods  which  can  be  used  to  provide  the  necessary  displacement  to 

compensate  for  the  deflections  in  the  robot  structure.  The  first  method  involves  using  the 
robot  to  produce  the  compensatory  displacement.  This  method  requires  that  the  computed 
displacement  at  the  tool  be  back  transformed  to  joint  coordinates.  The  compensation 
displacement  must  then  be  added  to  the  original  desired  displacement  at  that  joint  in  real 
time.  A  good  understanding  of  the  robot  controller  is  necessary  so  that  the  displacements 
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may  added.  The  quality  of  the  compensation  is  dependent  on  the  speed  which  the  joint 
servo  can  respond  to  the  additional  displacement  command.  For  most  large  robots,  the 
response  of  the  servo  is  too  slow  to  provide  effective  compensation.  The  second  method 
involves  mounting  the  workpiece  on  an  active  holder  which  is  able  to  produce  the  necessary 
compensation  displacements.  However,  this  active  holder  may  require  up  to  six  active 
degrees-of-freedom  to  provide  the  proper  compensation.  And  for  heavy  or  large  workplaces, 
the  size  and  performance  required  of  the  workpiece  holder  may  become  too  great  for  a 
practical  system.  The  final  method  uses  a  high  speed,  high  resolution  active  end  effector. 
Once  the  normal  deflection  displacement  is  calculated,  this  value  is  sent  to  an  external 
compensator.  The  compensator  then  directly  responds  to  this  input.  This  method  does 
not  require  back  transformations,  in  depth  software  knowledge  of  the  robot  controller,  or 
rely  on  the  dynamic  response  of  the  robot  servos  for  the  necessary  real  time  compensation. 

For  the  particular  application  of  edge  milling  sheet  metal  components,  only  a  single 
degree-of-freedom  device  is  required  to  eliminate  the  errors  caused  by  the  robot  deflections. 
A  high  speed  actuator  was  designed  and  the  device  could  provide  a  displacement  with 
+/-  0.0005  inch  (0.013  mm)  resolution.  A  six  degree-of-freedom  force/torque  transducer 
incorporating  a  strain  bridge  was  used  to  provide  the  necessary  force  information.  The 
external  compensator  uses  a  standard  Personnel  Computer  for  the  real  time  control  of  the 
actuator.  This  results  in  a  inexpensive,  stand-alone  system  which  could  be  easily  adapted 
to  a  number  of  industrial  robots.  By  providing  the  proper  displacement  input,  digital  or 
analog,  the  actuator  can  quickly  and  accurately  respond. 

During  the  experimentation,  the  flexibility  matrices  for  specific  positions  of  the  robot 
were  manually  put  into  the  controlling  computer.  For  a  more  practical  implementation, 
the  position  of  the  robot  should  be  monitored  in  real  time,  and  from  the  position  of  the 
robot,  the  flexibility  matrix  could  be  updated  as  required.  New  software  releases  from 
Cincinnati  Milacron  allow  the  position  of  the  robot  in  either  joint  or  global  coordinates  to 
be  down  loaded  to  a  PC  or  DEC  computer  in  a  real  time  manner.  This  should  be  included 
in  future  updates  of  the  flexibility  compensation  scheme. 
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For  the  flexibility  compensation,  two  types  of  tests  were  made,  static  and  dynamic.  For 
the  static  tests,  various  loads  were  applied  to  the  end  effector,  the  loads  were  measured 
by  the  force/torque  sensor  and  multiplied  by  the  position  dependent  flexibility  matrix. 
The  product  was  the  compensation  displacement,  which  was  converted  to  analog  signal 
to  drive  the  compensator.  Displacements  of  up  to  0.030  inch  (0.76  mm)  for  a  40  pound 
(18.2  Kg)  static  load  were  reduced  to  0.002  inch  (0.05  mm).  By  improving  the  flexibility 
model  of  the  robot,  it  is  possible  to  further  reduce  the  deflection  error.  For  example,  the 
flexibility  matrix  was  slightly  modified  by  trial  and  error  until  the  static  deflections  were 
completely  eliminated. 

Dynamic  cutting  tests  were  then  performed.  Simple  straight  line  paths  were  pro- 
grammed. Steps  were  premachined  into  the  workpiece  to  provide  changes  in  the  cutting 
force.  For  the  paths  chosen,  both  the  measured  and  calculated  flexibility  matrices  changed 
very  little,  less  than  15%.  A  single  flexibility  matrix  was  used  to  represent  the  complete 
path.  The  results  revealed  that  the  uncompensated  displacements  normal  to  the  desired 
path  resulted  in  errors  of  up  to  0.015  inch  (0.38  mm),  and  with  the  compensator  active, 
these  errors  were  reduced  to  approximately  0.007  inch  (0.18  mm).  The  improvement  may 
have  been  more  evident  had  the  Metal  Removal  Rate  (MRR)  been  greater,  resulting  in 
a  greater  applied  force  to  the  system.  In  any  case,  errors  of  this  magnitude  are  still  too 
great  to  allow  templateless  edge  milling  unless  additional  compensation  techniques  are 
imposed. 

A  majority  of  the  path  errors  in  the  compensated  trial  may  be  attributed  to  the 
poor  straight  line  performance  of  the  robot.  The  poor  straight  line  motion  is  due  to 
a  combination  of  factors  including  sensors,  computer  round  off  and  interpolation,  and 
environmental  factors.  A  compensation  technique  was  developed  which  addressed  these 
error  sources  as  a  group.  A  record  of  one  of  the  straight  line  paths  was  made  without  any 
externally  applied  loads,  and  tl;e  resulting  profilograms  revealed  normal  displacements 
from  the  desired  path  of  up  to  +/-  0.010  inch  (0.25  mm).  It  is  apparent  that  to  provide 
the  necessary  surface  quality,  the  straight  line  motion  has  to  be  improved.    In  the  final 
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chapter,  methods  of  improving  the  straight  line  motion  of  the  robot  were  discussed. 

Several  techniques  were  explored,  but  an  accelerometric  technique  was  chosen  because 
of  its  perceived  simplicity.  By  attaching  an  accelerometer  to  the  tool  in  the  direction 
normal  to  the  desired  tool  path,  displacements  normal  to  the  tool  path  can  be  ideally 
observed.  This  method  requires  the  double  integration  of  the  accelerometric  signal.  The 
requirements  made  for  the  integrators  were  an  operating  bandwidth  between  0.5  and  30 
Hz  with  minimal  phase  distortion,  and  most  importantly  the  circuits  should  be  designed 
so  they  do  not  saturate.  These  requirements  appear  to  contradict  with  one  another. 

To  reduce  the  possibility  of  saturation,  high  pass  filters  were  introduced  to  the  input 
of  the  integrators.  This  effectively  attenuates  the  low  frequency  components,  however,  the 
high  pass  filter  introduced  an  unwanted  phase  distortion  in  the  transfer  function.  The  high 
pass  filters  were  thus  eliminated.  Low  pass  filters  with  a  corner  frequency  of  approximately 
20  Hz  were  then  introduced  to  eliminate  unwanted  noise  from  the  system.  However,  these 
too  introduced  phase  distortion  in  the  system,  but  the  phase  distortion  between  1  and 
5  Hz  was  small.  This  circuit  was  selected  for  compensation. 

The  accelerometer  was  attached  to  the  external  compensator  and  an  impulse  force  was 
applied  to  the  robot  in  the  normal  direction  of  the  tool.  This  caused  the  external  servo  to 
become  unstable.  The  cause  of  this  instability  was  traced  to  the  first  mode  of  vibration 
of  the  external  compensator  in  the  normal  direction,  which  occurred  at  23.5  Hz.  A  notch 
filter  was  designed  and  introduced  to  the  system  to  attenuate  this  mode  of  vibration.  This 
allowed  the  low  pass  filter  and  its  associated  phase  shift  to  be  eliminated  from  the  circuit. 
Initially,  it  appeared  that  a  single  integrator  could  be  used  if  its  output  was  introduced 
to  the  velocity  input  of  the  servo,  integrating  acceleration  signal  once  produces  a  velocity 
signal.  The  resulting  experiments  revealed  an  excellent  reproduction  of  various  frequency 
sinusoidal  inputs  by  the  external  servo,  but  a  90  degree  phase  shift  was  present.  After 
examining  the  transfer  function  of  the  servo  it  became  apparent  that  a  single  integration 
of  the  input  signal  would  not  provide  the  necessary  output  from  the  external  servo  and 
double  integration  was  indeed  required. 
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A  series  of  experiments  finally  led  to  the  development  of  an  integrator  which  met  all 
of  the  original  requirements.  The  integrator  incorporated  a  low  frequency,  high  pass  filter 
to  attenuate  DC  bias  voltages.  The  corner  frequency  of  the  filter  was  equal  to  0.05  Hz, 
and  the  components  used  to  build  the  circuit  approached  the  limits  of  real  components, 
for  example  10  megaohm  resistors  and  100  microfarad  capacitors.  Two  of  these  integrator 
circuits  were  built,  and  the  resulting  transfer  function  appeared  to  meet  the  required 
integration  specifications  quite  well.  Linear  response  from  0.5  Hz  and  constant  phase  shift 
from  approximately  1.0  Hz.  Most  importantly,  the  circuit  did  not  saturate.  However, 
when  the  circuit  was  connected  to  the  accelerometer,  the  circuit  would  quickly  saturate. 
A  stray  DC  voltage  was  creating  the  failure.  DC  bias  circuits  were  introduced,  and  the 
circuit  was  carefully  adjusted,  but  the  system  would  continue  to  saturate. 

Perhaps  a  more  experienced  designer  could  develop  a  circuit  which  automatically  ad- 
justs the  voltage  bias  circuit  so  any  stray  DC  signal  can  be  attenuated.  Another  path 
would  be  to  develop  a  digital  integration  circuit  or  perhaps  a  hybrid  digital/analog  cir- 
cuit. Special  digital  filtering  techniques  might  be  employed  to  eliminate  these  problems. 

It  is  evident  that  once  the  external  compensator  receives  the  necessary  input,  the 
system  can  respond  and  greatly  improve  the  motion  of  the  tool.  For  example,  a  capacitance 
probe,  used  to  measure  the  normal  deflection  of  the  robot  was  used  as  an  input  to  the 
external  compensator.  The  charge  amplifier  of  the  capacitance  probe  produces  a  voltage 
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1  proportional  to  the  displacement  of  the  probe.  This  analog  signal  was  connected  to  the 

input  of  the  external  servo,  and  displacements  normal  to  the  desired  path  were  reduced  by 

I  one  order  of  magnitude.  The  deflections  when  compensated  in  this  manner  were  reduced 

to  -H/-  0.002  inch  (0.05  mm)  or  less. 

At  this  time,  it  may  be  useful  to  look  at  alternate  methods  which  provide  a  measure 
of  the  deflection  displacement.  Several  closed  form  solutions  were  explored,  where  the  po- 
sitional error  could  be  directly  measured,  not  estimated  as  in  the  flexibility  compensation 
or  observed  as  in  the  accelerometric  compensation  method.  The  closed  form  solution  has 
the  advantage  of  including  all  sources  of  error,  regardless  of  their  origin.  The  rigid  tem- 
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plate  method  provides  a  mechanical  closed  form  solution,  where  the  errors  are  eliminated 
because  the  tool  is  guided  by  a  rigid  mechanical  reference. 

The  most  obvious  closed  form  compensation  method  would  be  to  use  a  displacement 
probe  to  measure  the  normal  displacement  of  the  tool  from  a  fixed  reference.  With  the 
error  known,  the  compensator  would  be  commanded  to  produce  this  displacement,  thus 
eliminating  the  normal  error.  For  straight  line  motions,  this  is  a  trivial  task,  just  clamp 
a  strait  edge  to  the  workpiece  at  the  appropriate  position  for  the  reference.  For  complex, 
three  dimensional  components,  the  reference  edge  would  need  the  same  contour,  requiring 
difficult  machining  of  the  reference  edge.  Thus,  a  special  'reference'  template  would  have 
to  be  manufactured  for  each  part,  as  was  provided  for  the  mechanical  template. 

A  second  direct  measurement  scheme  would  require  that  the  tool  path  be  scribed 
directly  on  the  workpiece,  eliminating  the  need  of  a  template  to  directly  guide  the  robot. 
Vision  systems  could  easily  detect  and  follow  the  scribed  mark  on  the  workpiece.  The 
vision  hardware  would  be  located  in  the  same  PC  as  the  servo  control  system.  This 
system  could  provide  updated  position  commands  to  the  servo  at  approximately  60  Hz. 
But  alas,  another  form  of  'scribing'  template  or  guide  would  be  required  when  marking 
the  path  on  the  workpiece. 

The  closed  form  solutions,  when  coupled  with  the  high  speed  external  compensating 
servo,  have  several  advantages  over  other  compensation  methods:  they  eliminate  all  types 
of  path  errors  regardless  of  their  cause,  they  provide  real  time  displacement  measure- 
ment and  compensation,  they  are  generic  and  can  be  applied  to  any  robot,  they  are  self 
contained  and  they  do  not  require  communications  with  other  systems  (ie.  the  robot  con- 
troller), and  they  require  no  knowledge  of  the  robot  they  are  attached  to  (ie.  flexibility 
model).  However,  these  closed  form  solutions  require  that  the  tool  path  or  a  reference 
path  be  provided  for  all  motions  requiring  compensation.  This  means  a  form  of  template 
is  required  for  each  closed  form  method.  Elimination  of  the  template  was  one  of  the 
original  requirements. 

A  final  pseudo  closed  form  compensation  method  was  investigated.    It  used  a  high 
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resolution,  real  time  tracking  device  to  locate  the  position  of  the  tool  in  Cartesian  coordi- 
nates. The  desired  position  of  the  robot  would  be  compared  with  the  actual  position  of  the 
robot  as  measured  by  the  tracking  system.  The  difference  is  equal  to  the  path  error  and 
would  be  used  to  drive  the  compensator,  thus  ideally  eliminating  the  positioning  error. 
However,  real  time  tracking  systems  with  the  necessary  resolution  are  expensive,  limiting 
the  number  of  realistic  applications.  This  method  also  requires  communication  between 
the  robot  controller,  the  tracking  system  and  the  external  servo  controller.  Robot  spe- 
cific communication  software  must  be  developed,  limiting  the  universal  portability  of  the 
system.  However,  once  the  communication  software  is  completed,  the  system  can  operate 
autonomously,  no  robot  specific  models,  complicated  algorithms  or  templates  are  required. 

Thus  two  methods  of  improving  the  absolute  positioning  capabilities  are  available 
without  using  templates.  For  applications  where  cost  is  not  critical,  the  pseudo  closed  form 
solution  using  the  realtime  tracking  system  may  provide  the  best  results.  In  applications 
where  cost  constraints  are  imposed,  modeling  the  error  sources  and  compensating  for 
the  errors  using  various  techniques  is  the  only  alternative  to  using  templates.  Several 
compensation  techniques  were  developed  and  demonstrated  with  positive  results. 

With  either  method,  the  external  positioning  servo  provides  fast,  high  resolution  po- 
sitioning or  force  control  at  the  end  effector.  The  external  compensator  can  be  attached 
to  any  industrial  robot.  It  could  be  scaled  up  for  larger  robots,  or  scaled  down  for  smaller 
robot  applications.  Additional  degrees-of-freedom  could  be  added  for  applications  requir- 
ing high  resolution  control  in  more  than  one  degree-of-freedom.  In  fact  a  five  degree-of- 
freedom  external  compensator  has  been  proposed  and  preliminary  designs  developed  for 
an  Automated  Umbilical  Connection  Device  for  use  at  the  Kennedy  Space  Center. 


APPENDIX  A 
CAUSES  FOR  INACCURACIES  IN  INDUSTRIAL  ROBOTS 


In  this  appendix,  several  general  categories  which  contribute  to  positioning  errors  are 
listed  and  described.  Much  of  this  information  has  been  discovered  through  experimenta- 
tion, but  a  concise  review  of  robot  errors  was  developed  by  C.  Day  in  the  article  "Robot 
Accuracy  Issues  and  Methods  of  Improvement"  [4]  and  is  used  as  outline  for  this  appendix. 

Environmental  Factors 

Environmental  factors  like  temperature  and  humidity  are  sometimes  overlooked  or  can- 
not be  changed  in  commercial  applications.  However,  these  factors  can  have  a  significant 
impact  on  the  accuracy  and  performance  of  an  industrial  robot.  For  example,  a  steel  screw 
(re-circulating  ball  type)  with  a  length  of  39.4  inch  (1000  mm)  may  change  its  temperature 
10°  Fahrenheit  (4.5"  Centigrade)  which  is  representative  of  the  temperature  changes  in  a 
plant,  the  length  of  the  screw  will  change  by  0.003  inch  (0.08  mm).  For  the  elbow  joint  of 
the  T3-776,  the  distance  of  the  end  effector  is  approximately  10  times  that  of  the  moment 
arm  of  the  ball  screw,  thus  a  change  of  W°F  (4.5°C)  in  the  ball  screw  could  produce  an 
error  of  0.030  inch  (0.80  mm)  at  the  end  effector. 

Changes  in  temperature  also  affect  dimensions  of  rotating  components  of  drive  mech- 
anisms. These  in  turn  produce  changes  in  stiction,  Coulomb  friction,  and  viscous  friction 
values.  Such  friction  related  factors  affect  the  characteristics  and  accuracy  of  robots  and 
they  introduce  additional  un-modeled  perturbations  to  the  robot  controller  [4].  These 
changes  due  to  temperature  could  be  modeled  in  the  controller  and  be  reduced  or  elimi- 
nated. 
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Kinematic  Factors 

As  mentioned  previously,  Kinematic  factors  include  improper  link  lengths  and  im- 
proper joint  It  is  intuitive  that  improper  link  lengths  will  lead  to  poor  positional  accuracy 
in  robots.  From  the  Environmental  Factors  section,  it  is  evident  that  changes  in  tem- 
perature effect  link  lengths  and  therefore  reduce  positional  accuracy.  Manufacturing  and 
assembly  errors  can  also  cause  improper  link  lengths  which  again  leads  to  reduced  posi- 
tional accuracy.  A  link  length  can  be  different  from  its  nominal  value  due  to  machining 
tolerances  and  tolerance  stack-ups  from  a  number  of  sub-assemblies  could  produce  addi- 
tional errors. 

Improper  angularity  between  a  pair  of  adjacent  axes  also  contributes  to  positional 
inaccuracies  at  the  end  effector  [9].  These  errors  can  be  attributed  to  machining  errors  or 
assembly  errors  of  joint  components  (such  as  in  the  incorrect  seating  of  bearings). 

Other  kinematic  factors  include  drivetrain  errors  including:  non-uniformity  of  gears, 
chains,  belts,  ball  screws  and  etc.  Obviously,  they  can  cause  positional  errors  of  the  robot. 
By  careful  measurements  of  the  links  and  drive  train  components  in  the  assembled  robot, 
many  of  these  kinematic  factors  could  be  modeled  and  included  in  the  robot  controller 
[33]. 

Dynamic  Factors 

Present  robots  are  typically  more  flexible  than  machine  tools.  This  introduces  prob- 
lems that  were  normally  ignored  in  the  machine  tool  industry  because  they  were  of  little 
consequence.  These  problems  include:  very  low  structural  frequencies,  inertial  effects  of 
other  joints  and  deflections  at  the  end  effector  due  to  gravity  and  external  applied  forces. 
Thus,  when  using  the  robot  to  provide  an  accurate  path  trajectory  at  the  tool,  the  dynamic 
effects  should  be  taken  into  account  by  the  robot  controller. 

Flexibility  in  the  robot  structure  can  be  introduced  by  several  causes.    They  will  be 

divided  into  three  groups: 

1.  Flexibihties  due  to  structural  members  or  link  structures. 
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2.  Flexibilities  due  to  bearings  at  the  joints. 

3.  Flexibilities  due  drive  mechanisms. 

Typically,  structural  members  are  designed  to  support  a  static  load  of  approximately 
10  times  that  of  their  rated  capacity,  thus  providing  sufficient  rigidity.  Little  improvement 
is  needed  in  the  form  of  link  structure  rigidity.  However,  by  increasing  the  rigidity  to  10 
times  the  required  static  load,  the  mass  of  the  link  is  greatly  increased,  thus  reducing  the 
load  capacity  at  the  end  effector.  Some  robot  manufacturers  are  presently  pursuing  the 
introduction  of  composite  structures  for  structural  members,  thus  reducing  the  mass  of 
the  link  and  simultaneously,  increase  its  stiffness. 

Bearings  at  the  joint  are  implemented  in  a  similar  manner,  they  are  usually  designed 
to  carry  several  times  the  required  loads  for  a  given  lile  and  provide  minimum  deflections 
under  moment  loading. 

From  a  detailed  dynamic  analysis  of  a  standard  T3-776  robot,  the  flexibilities  in  the 
joint  drive  mechanisms  produced  the  majority  of  the  structural  flexibilities  encountered 
in  the  robot  structure  [8].  Torque  tubes,  belts,  reduction  gear  sets  and  other  drive  train 
components  contribute  to  the  flexibilities  in  the  drive  train.  By  the  proper  placement 
of  the  encoders/resolvers,  the  effects  of  these  flexibilities  can  be  eliminated  over  time  by 
including  them  in  the  positional  control  loop  [15]. 

For  example,  if  an  encoder  were  mounted  at  the  joint,  the  flexibilities  between  the 
servomotor  and  the  joint  would  be  included  in  the  positional  feedback  loop  and  will  be 
eliminated  over  time.  For  very  flexible  drive  trains,  this  type  of  arrangement  can  lead  to 
instabilities  and  therefore  advanced  control  strategies  must  be  developed  and  implemented 
in  these  cases.  However,  those  flexibilities  which  are  not  included  in  the  positional  feedback 
loop  need  to  be  eliminated  by  other  means.  By  modeling  the  flexibilities  of  the  robot 
structure  accurately  and  measuring  external  forces  at  the  end  effector  in  real  time,  the 
effect  of  these  external  flexibilities  may  be  eliminated  over  time.  This  method  of  flexibility 
compensation  was  demonstrated  in  Chapter  5. 

Inertial  parameters  play  a  role  in  the  trajectory  accuracy  and  the  desired  velocity  of 
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robots.  It  can  be  shown  that  by  varying  the  position  of  down  stream  links,  the  inertial 
load  reflected  back  to  the  base  axis  of  the  T3-776,  for  example,  can  vary  by  ten  times  or 
more.  This  could  effect  the  velocity  response  of  the  base  axis,  making  the  velocity  response 
of  the  base  axis  essentially  dependant  on  the  position  of  the  end  effector.  Thus  dynamic 
compensation  should  be  implemented  on  robots  which  are  affected  by  the  varying  inertial 
loads.  Several  dynamic  compensation  methods  were  discussed  in  Chapter  2. 

In  addition  to  inertial  effects,  friction  plays  a  vital  role  in  the  performance  of  the  robot. 
Friction  parameters  of  robots  are  difficult  to  quantify  accurately.  In  a  typical  axis  drive 
train  (not  a  direct  drive  system)  only  50  percent  to  90  percent  of  the  servomotor  out  put 
power  is  delivered  to  the  joint.  The  rest  of  the  power  is  lost  as  heat  in  the  drive  train. 
In  most  cases,  it  is  extremely  difficult  to  accurately  quantify  friction,  and  include  fric- 
tion compensation  in  the  robot  controller.  Obviously,  proper  lubrication  reduces  friction, 
improves  efficiency  and  increases  the  life  of  drive  components.  All  friction  parameters 
dissipate  energy  and  contribute  to  robot  inaccuracy  [4]. 

Measurement  Factors 

Resolvers  and  encoders  provide  the  most  common  type  of  positional  feedback  on  indus- 
trial robots.  As  mentioned  previously,  the  placement  of  resolvers  or  encoders  can  reduce 
the  effects  of  flexibilities  in  drive  train  components.  If  the  encoder  were  placed  at  the 
joint  (to  allow  the  inclusion  of  the  drive  train  flexibilities)  the  resolution  of  that  encoder 
would  have  to  be  great  to  detect  small  motions  at  the  joint.  Resolutions  of  up  to  several 
thousand  counts  per  revolution  are  necessary.  Conversely,  if  the  encoder  were  mounted 
at  the  servomotor,  the  effective  resolution  of  the  encoder  would  be  multiplied  by  the  gear 
ratio  of  the  drive  train,  and  the  encoder  could  have  a  coarser  resolution.  In  this  configura- 
tion (the  encoder  at  the  servomotor),  compliance  of  the  drive  train  components  can  affect 
the  performance  and  accuracy  of  the  robot,  especially  with  heavy  loads  or  large  external 
forces. 

In  some  instances,  force  sensors  such  as  strain  gauges  located  on  flexible  links  or 
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wrist  mounted  dynamometers  are  used  to  detect  external  forces  and  provide  feedback  to 
compensation  mechanisms  which  will  reduce  positional  errors  due  to  applied  forces.  Most 
commercial  dynamometers  incorporate  a  six  degree-of-freedom  bridge,  instrumented  with 
strain  gauges.  Strain  gauges  introduce  measurement  errors  due  to  the  analog  type  output, 
temperature  changes  or  mounting  techniques.  These  measurement  errors  can  be  reduced 
through  periodic  calibration  and  maintenance  procedures. 

External  measurement  schemes  are  sometimes  employed  to  reduce  the  positional  error 
of  a  robot  or  to  provide  a  method  to  calibrate  the  position  of  the  robot.  The  advantage  of 
using  an  external  measurement  system  would  be  that  a  majority  of  the  causes  of  positional 
error  could  be  included  in  the  positional  feedback  loop  of  the  robot  controller.  There  would 
be  little  need  in  accurately  modeling  and  analyzing  a  robot  to  determine  possible  sources 
of  positional  error.  They  provide  reliable  measurements  of  robot  accuracy  independent  of 
robot  parameters. 

Among  the  various  instruments  used  in  external  positional  measurement  systems  are: 
laser  interferometer,  theodolite,  opto-camera  systems  and  pose  measuring  devices.  These 
external  devices,  such  as  a  laser  interferometer,  provide  high  resolution  positioning  accu- 
racy, up  to  0.02  mm  in  one  direction  for  a  moving  target.  Some  of  these  measurement 
techniques  are  for  static  or  pose  measurements  only,  for  example:  theodolite,  eddy  current 
probes,  capacitance  probes  and  position  sensitive  detectors  with  coUimated  light  beams. 
Laser  tracking  provides  real  time  measurement  of  the  position  (and  in  some  cases  the 
orientation)  of  the  robot  end  effector,  but  with  reduced  accuracy  (0.1  mm)  and  high  costs. 

Computational  Factors 

When  robots  are  programmed  in  the  typical  point  to  point  manner,  the  desired  tool 
position  (or  end  effector  position)  is  recorded  for  the  various  points.  Trajectories  are  later 
developed  to  allow  a  coordinated  motion  through  the  taught  points.  This  trajectory  com- 
putation takes  time,  from  several  milliseconds  to  several  hundred  milliseconds  depending 
on  the  robot.  These  tool  point  trajectories  are  then  broken  down  to  actual  desired  joint 
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positions.  In  most  controllers  a  16  bit  word  is  used  represent  the  calculated  numbers  and 
in  some  cases  the  accumulation  of  round  off  errors  will  produce  significant  inaccuracies  at 
the  end  effector.  It  is  evident  that  by  increasing  the  number  of  bits  to  32  for  example,  will 
help  to  reduce  the  errors  due  to  round  off.  In  fact  some  robot  manufacturers  are  offering 
32  bit  micro-processors  on  their  machines. 

In  addition  to  round  off  errors,  most  robot  manufacturers  use  an  inverse  kinematic 
solution  to  calculate  desired  joint  positions.  In  this  solution,  most  manufacturers  assume 
that  the  actual  link  lengths  are  equal  to  the  lengths  specified  in  the  original  design.  As 
mentioned  earlier,  there  are  errors  in  manufacturing  that  may  cause  the  inverse  kinematic 
solution  to  be  rather  inaccurate. 

Another  type  of  error  which  can  be  found  in  the  robot  controller  is  the  error  produced 
due  to  analog  signal  interpolation.  Analog  signals  in  the  positional  loop  include  the  out 
put  of  resolvers,  potentiometers  and  tachometers.  Similar  to  errors  in  A/D  converters  are 
the  errors  from  D/A  converters. 

Application  Errors 

The  previously  mentioned  factors  (Environmental,  Kinematic,  Dynamic,  Measurement 
and  Computational)  affect  both  the  absolute  and  joint  accuracy  as  defined  earlier.  While 
joint  and  absolute  positional  accuracies  are  important,  ultimately  the  relative  accuracy 
at  the  work  piece  is  the  highest  priority.  The  relative  accuracy  at  the  work  piece  can  be 
compromised  by  the  following  problems:  improper  installation  of  the  robot,  inaccurate 
location  of  the  work  piece  and  inaccurate  location  of  end-of-arm  tooling. 

Some  of  the  inaccuracies  at  the  end-of-arm  tooling  can  be  traced  to  the  flexible  mount- 
ing of  the  robot  base.  It  is  critical  for  most  industrial  applications  that  robots  be  properly 
secured  with  anchors  as  per  manufacturers  instructions.  This  will  provide  a  more  accurate 
robot  world  coordinate  system,  which  all  other  robot  coordinate  systems  are  based. 

Additionally,  the  work  piece  reference  frame  must  be  accurately  known  and  fixed,  in 
relation  to  the  robot's  world  coordinate  system.   If  the  location  of  the  work  piece  is  not 
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known  exactly  (in  the  robot's  world  coordinate  reference  frame),  the  relative  accuracy 
of  the  robot  at  the  work  piece  will  be  reduced.  These  in-accuracies  will  be  especially 
noticeable  for  robot  path  programs  produced  off-line. 

There  are  several  causes  of  poorly  known  work  piece  reference  frames  including:  flexible 
work  piece  fixturing,  improperly  measured  fixture  location  in  robot  world  coordinates  and 
improperly  mounted  work  pieces. 

Precise  knowledge  of  the  location  of  end-of-arm  tooling  is  required  for  accurate  ma- 
chining. If  the  tool  coordinates  were  measured  in-accurately  or  a  flexible  tool  holder  is 
used,  the  exact  location  of  the  tool  will  not  be  known.  This  would  lead  to  offsets  in  the 
location  of  drilled  holes,  for  example. 

1  Flexibihties  due  to  structural  members  or  link  structures. 

2  Flexibihties  due  to  bearings  at  the  joints. 

3  Flexibilities  due  drive  mechanisms. 


APPENDIX  B 
EQUIPMENT  DESCRIPTION 


Cincinnati  Milacron  T3-776  Robot 

The  robot  used  in  this  research  was  a  Cincinnati  Milacron  T3-776  industrial  robot. 
This  robot  uses  high  torque,  DC  servomotors  to  drive  the  six  axis  serial  manipulator.  The 
base  axis  of  the  robot  is  driven  by  a  set  of  crown  and  pinion  gears,  wlrich  are  preloaded 
to  reduce  backlash.  The  shoulder  and  elbow  joints  use  recirculating  ball  screw  drives  in 
a  simple  four  bar  arrangement.  The  wrist  is  a  compact  three  roll  revolute  device,  with 
the  actuators  located  at  the  elbow.  Co-axial  torque  tubes  are  used  to  transfer  the  torque 
from  the  actuators  to  the  individual  joints  of  the  wrist  as  illustrated  in  Figure  B.l. 

The  robot  has  a  stated  load  carrying  capacity  of  150  pounds,  with  the  manipulator  fully 
extended.  The  repeatabihty  of  the  device  is  stated  as  +/-  0.015  inches.  A  teach  pendant 
is  used  to  program  the  robot,  but  a  recent  option  allows  the  robot  to  be  controhed  on  line 
in  real  time  using  either  global  or  joint  coordinates.  This  feature  would  allow  the  path 
of  the  robot  to  commanded  directly  from  a  CADAM  type  system  or  if  some  corrective 
motions  were  needed  they  could  be  directly  commanded  to  the  robot  controller  by  a  host 
computer. 

Figure  B.2  illustrates  the  control  architecture  of  the  T3-776.  An  Intel  16  bit  bus  is 
used  to  provide  communication  between  the  various  components  in  the  controller.  An 
8086  based  microprocessor  is  used  to  supervise  the  controller,  and  in  this  module,  the 
desired  commands  of  the  path  program  are  carried  out.  A  second  8086  microprocessor  is 
used  to  transform  the  path  in  tool  coordinates  to  the  required  joint  coordinates.  The  joint 
coordinates  are  updated  at  15  msec  intervals.  Also  connected  to  the  bus  are  extended 
dynamic  memory  card,  serial  I/O  cards  and  the  servo  I/O  boards  which  actually  produce 
the  motion  command  for  the  servos.  Each  servo  I/O  board  controls  two  motor  controllers. 
Each  motor  controller  in  turn  produces  the  current  used  to  drive  each  actuator.  A  feed 
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Figure  B.l:  Cincinnati  Milacron  T3-776  Wrist  Assembly 

back  resolver  sends  back  position  information  to  the  servo  I/O  and  the  difference  is  used 
to  drive  the  motor  controllers. 

Dynamic  Analyzer 


For  the  dynamic  modeling  of  the  robot  structure  and  the  system  modelling  of  the  robot 
controller  and  electronic  circuits,  a  GenRad  2515-9175  Dynamic  Analyzer  was  used.  The 
GenRad  provided  four  measurement  channels  at  the  front  of  the  chassis,  and  an  expansion 
block  providing  an  additional  12  channels  was  later  added  to  the  machine.  The  GenRad 
provided  real  time  data  acquisition  and  storage  of  up  to  512  K  bytes  of  information  at 
up  to  4096  Hz.  This  information  could  then  be  reviewed  in  a  number  of  different  formats 
including  time  and  frequency  displays.  Additionally,  transfer  functions  may  be  obtained 
from  any  pairs  of  channels  selected,  and  multiple  transfer  functions  could  be  produced  as 
required. 

Additional  features  of  the  machine  include  curve  fitting  of  transfer  functions,  and  the 
automatic  generation  of  animated  mode  shapes  of  structures.  The  GenRad  also  provides  a 
signal  generator  with  various  outputs  including  random  noise  over  fixed  frequency  ranges. 
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The  random  noise  generator  was  used  to  provide  signals  to  produce  the  transfer  functions 
of  the  various  circuits  described  earlier. 

The  instrumented  hammer  and  acclerometer  used  in  the  experiments  were  manufac- 
tured by  PCB  instruments.  The  hammer  and  impact  transducer  was  PCB  model  086B20 
Short  Sledge  Hammer,  with  a  of  sensitivity  1.04  mv/lb  (0.23  mv/N),  range  0  -  5000  lb  (0 
-  22300  N).  PCB  model  084A60  Impact  Super  Soft  Tip  and  an  additional  mass  of  0.35 
slug  (5.11  Kg)  were  used  with  the  hammer.  The  accelerometer  used  was  PCB  model  393C 
Seismic  Accelerometer,  with  a  sensitivity  of  1.007  V/g.  A  PCB  charge  amplifier  model 
480  DC6  Power  supply  was  used  to  condition  the  output  of  the  acclerometer. 


APPENDIX  C 
SIMULATION  PROGRAMS 


INITIAL 

CINTERVAL        CINT=.001 

MAXTERVAL        MAXT= .001 

NSTEPS=1 

CONSTANT  DT=.0005,TSTP=1.0 

CONSTANT  S1=1,S2=.01,S3=0,S4=0,S5=10,S6=1,S7=0 

CONSTANT  KP=10 , HV=0 . 08 , KV=1 , TL=0 , VC=0 

CONSTANT  KE=.155,R=.75,KT=.155 

CONSTANT  JM=.0002,GR=1,C=10 

CONSTANT  K=50  0,M=1 

"THIS  PROGRAM  SIMULATES  A  GENERAL  DC  SERVO  AND  CONTROLLER" 

"SI  -  INPUT  COMMAND  II,  S2  -  VEL.  FB  GAIN,  VC  -  COMP  VOLT" 

"S3  -  COMP  GAIN,  S4  -  LOAD  TQ  SWITCH,  TL  -  EXT.  LOAD  TQ" 

"S5  -  LIMITS  OF  CURRENT  AMPLIFIER" 

"S6=l,  S7=0  -  EXTERNAL  FLEX;  S6=0,  S7=l  -  INTERNAL  FLEX" 

"KP  -  POSITIONAL  GAIN,  HV  -  TACH  GAIN,  KV  -  VEL  LOOP  GAIN" 

"KE  -  EMF  VOLT  FB  CONS,  R  -  RESISTANCE,  KT  -  TORQUE  CONS" 

"JM  -  MOTOR  INERTIA,  GR  -GEAR  REDUCTION  RATIO,  C  -  DAMPER" 

"K   -  EXTERNAL  SPRING  CONSTANT,  M  -  EXTERNAL  LOAD  CONSTANT" 
END 
DYNAMIC 

T    =  T+DT 

II   =  S1*STEP(0.05) 
"II  -  STEP  INPUT" 

PV   =  (I1-(X*S6+Y*S7) ) *KP 
"PV  -  VOLTAGE  FROM  POSITIONAL  LOOP" 

VM   =  (PV+VC*S3-HV*S2*XD) *KV 

V    =  VM-KE*XD 

I    =  V/R 

I    =  BOUND(-S5,S5,I) 
"I  -  CURRENT  TO  MOTOR" 

TT   =  KT*I 

TM   =  TT-(TL*S4) 
"TM  -  TORQUE  REQUIRED  TO  ACCELERATE  MOTOR" 

XDD  =  TM/JM 

XD   =  XD+XDD*DT 

X    =  X+XD*DT 
"X  -  POSITION  OF  MOTOR" 

XR   =  X/GR 

XRD  =  XD/GR 

YDD  =  (XRD*C-YD*C+XR*K-Y*K)/M 
YD   =  YD+YDD*DT  ,. 

Y    =  Y+YD*DT 
"Y  -  THE  OUTPUT  OF  AN  ATTACHED  SPRING/MASS/DASHPOT  SYSTEM" 

END 

TERMT(T.GE.TSTP) 
TERMINAL 
END 
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INITIAL  ^^^„ 

"PROGRAM   NAME  IS    SIEMENS. CSL" 

CINTERVAL  CINT=.0001 

MAXTERVAL  MAXT= .0001 

follllm    DT=. 00001, TSTP=. 25, K=30.0,WN=10000 
rONSTANT    R=0. 64, L=0. 00353, JM=0. 002, KT=1.0,KE-0 
SSI?^?   ?I=3. 14159, K=30,T=0,VM=0,VX=0,VB=0ID=0, 1=0 
CONSTANT   TT=0,TM=0,TL=0,WD=0,WM=0,TV=0,VDO=0 
CONSTANT   VP=0 , VKDD=0 , VKD=0 , VK=0 , VD=0  ,  SO=0 , SN=0 


CONSTANT  VQD=0,VQ=0,SO=0,SD-0 

CONSTANT  Sl= . 25 , S2=- . 045 , S3= . 15 , S4=-20 , S5-50 , S6-1 , S7-1 

"?SlS^ROG^  E^LATES  THE  SIEMENS  CONTROLLER  OF  THE  T3" 


END 
DYNAMIC 

T=T+DT 

VC=S1*STEP(.1+S2) 

VP=VC-TV*S3 

VDO=VD 
VKDD=K*VP*WN*WN-2*WN*VKD-WN*WN*VK 

VKD=VKD+VKDD*DT 

VK=VK+VKD*DT 

VD=BOUND(-12.0,12.0,VK) 

VQD=VD*S4 

VQ=VQ+VQD*DT 

SO=SIGN(1.0,VDO) 

SN=SIGN(1.0,VD) 

IF(SO.NE.SN)VQ=0 

VM=-S5*VQ 
VB=(VM*S6+S7)*C0S(180*2*PI*T) 

VX=VM+VB 

I=VX/R 

TT=KT*I 

TM=TT-TL 

WD=TM/JM 

WM=WM+WD*DT 

TV=WM*0. 1814 

END 

TERMT(T.GE.TSTP) 

TERMINAL 
END 

T=0 

VC=0 

VP=0 

VDO=0 

VKDD=0 

VKD=0 

VK=0 

VD=0 

VQD=0 

VQ=0 

SO=0 

SN=0 

S0=0 

SN=0 

VM=0 

VB=0 

VX=0 

ID=0 

I  =0 
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APPENDIX  E 
PC  CONTROL  SOFTWARE 


type    trys'-dan  .  pas 
■C$1    FCLDEFS.TP3- 
<:$!    PCLERRS.PAS3- 
VAR 

LB,  MB,:  byte; 

WRDiARRhYCI  -  .7:  OF  IMTEGizH'- 

FLAG , WRD 1 , R_RDY , EASE_PQRT , ADVALUE , STATUS , Y : I N I ESLR  ? 
ACCL:REAL; 
PROCEDURE  RED7U0RD ; 
BEGIN 

FL.AG:  =  l; 

FORTuEA3E_PGRT:1:=FORT:EASE_PORT3  or  li;    f.    SENDS  THE  HANDSHAKE 
PaRTCEASE_FORT]:=FaRTCBASE_PGRT]  AfJD  239;  i    PULSE  TO  CRSO  ]■ 
REPEAT 
REPEAT 

R_RDY:^RCRTEBASE_pnRTj  AND  ii^V 
UMTIL  <R_RDY=£''+;  :, 

LB:=paRTi:BHSE_PQPT-i-^:-:  ?  -C  READS  LCW  BYTE  OF  IvORD  > 
H£:--=PORTEEASE_FORT^-oj  ;  i    READS  HX  BYTE  OF  WOF;D  :■ 
WRDHFLAG:  :=LB^E56^HB;  -C  ASSEMBLES  THE  DATA  UORD  ]■ 
FLAG:=FLA3+1 ; 
UNTIL  (FLAG=a) H 
END- 

•C  MAIN  I 
BEGIN 

BAGE_PORT : -396 ; 
REPEAT 
■:        RED7N0RD ;  > 
CLRSCRj 

STATUS:=/nITIALIZE5 
STATUS : =SELEETSOARO (1 ) ? 
STATUS  :  =ADCVALUE  '.  0  ,  1  ,  ADVALUE  )   ; 
STATUS ; =T£RM I NATE  5 
ACCL:=INT( 100*( ( ADVALUE-SC^7 ) /SOh . 3) )/100; 

FLAG :  ^-a  - 
REPEAT 

GOTOXY  (.35  ,  E+FLAG  )  • 
-TEXTCOLOR  (  l"+FLAG  )  ; 
WR I TELN ( WRD  C  FLAG : )  ; 
FLAG  -.  =FLAG+ 1  ; 
UNTIL (FLAG=5) ; 

GOTOXY (35,11) ; TEXTCOLOR ( 7 ) ; 
WRITE(ACCL); 
REPEAT  Y : =Y+ 1 ;  UNT I L  ( Y=200 ) ; Y : =0 ; 
UNTIL  (KEYPRESSED) 5 
END . 
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